/****************************************************************************************************************************/
//Functions and TASK
//for paper cutting
//TASK_Cut_Paper should be called as often as needed

void START_Cutting(byte cut_method)
{
  if (cut_method == FULL_CUT)
    {
      CUTB = 0;
      CUTA = 1;
    }
  else
    {
      CUTA = 0;
      CUTB = 1;
    }
  cutter_timer = 0;
}

void STOP_Cutting(void)
{
  CUTA = 0;
  CUTB = 0;
}

void Brake_Cutter(byte cut_method)
{
  if (cut_method == FULL_CUT)
    CUTB = 1;
  else
    CUTA = 1;
}

void Reverse_Cutter(byte cut_method)
{
  START_Cutting(!cut_method);
}

byte Cutter_Error_Handle(void)
{
 
  return True;
}

void TASK_Cut_Paper(byte cut_method)  //cut_method -> FULL_CUT =(1); !FULL_CUT =(0) =(ONE_POINT);
{
  byte Sender;  //Sender is used for calling brake process with or w/o Error.
      switch (CUTTER_STATUS)
        {
          case cut_IDLE:
            {
              if (//!(COMMON_STATUS & cs_PRINT_IN_PROGRESS) && //if NOT printing!!!
                   (COMMON_STATUS & cs_CUT_ENABLED))  //check cs_CUT_ENABLED!!!
                {
                  START_Cutting(cut_method);
                  COMMON_STATUS = COMMON_STATUS | cs_CUTTER_IN_PROGRESS;
                  CUTTER_STATUS = cut_PROCESS1;
                }
              break;
            }
          case cut_PROCESS1:
            {
              if (cutter_timer < ms500)
                {
                  if (CUT_HP == !CUTTER_AT_HOME)
                    {
                      cutter_timer = 0;
                      CUTTER_STATUS = cut_PROCESS2;
                    }
                }
              else
                {
                  STOP_Cutting();
                  CUTTER_STATUS = cut_ERROR;
                }
              break;
            }
          case cut_PROCESS2:
            {
              if (cutter_timer < ms1000)
                {
                  if (CUT_HP == CUTTER_AT_HOME)
                    {
                      Brake_Cutter(cut_method);  //start motor braking
                      cutter_timer = 0;
                      CUTTER_STATUS = cut_BRAKE;
                    }
                }
              else
                {
                  STOP_Cutting();
                  Reverse_Cutter(cut_method);
                  cutter_timer = 0;
                  CUTTER_STATUS = cut_PROCESS_ERROR;
                }
              break;
            }
          case cut_PROCESS_ERROR:
            {
              if (cutter_timer < ms1000)
                {
                  if (CUT_HP == CUTTER_AT_HOME)
                    {
                      Brake_Cutter(!cut_method);
                      cutter_timer = 0;
                      Sender = CUTTER_STATUS; 
                      CUTTER_STATUS = cut_BRAKE;
                    }
                }
              else
                {
                  STOP_Cutting();
                  CUTTER_STATUS = cut_ERROR;
                }
              break;
            }
          case cut_BRAKE:
            {
              if (cutter_timer >= ms100)
                {
                  STOP_Cutting();
                  if (Sender == cut_PROCESS_ERROR)
                    CUTTER_STATUS = cut_ERROR;
                  else
                    CUTTER_STATUS = cut_END;
                }
              break;
            }
          case cut_ERROR:
            {
              if (Cutter_Error_Handle())
                CUTTER_STATUS = cut_END;
              break;
            }
          case cut_END:
            {
              COMMON_STATUS = COMMON_STATUS & ~cs_CUTTER_IN_PROGRESS;//(cs_CUTTER_IN_PROGRESS ^ cs_CUTTER_IN_PROGRESS);  //cutting ended, clear flag
              COMMON_STATUS = COMMON_STATUS & ~cs_CUT_ENABLED;//(cs_CUT_ENABLED ^ cs_CUT_ENABLED);  //disable cutting, CHECK!!!
              //COMMON_STATUS.7 = 0;
              CUTTER_STATUS = cut_IDLE;
              break;
            }         
        }     
}

/****************************************************************************************************************************/