sbit sw_dir1 at         Ra4_bit;
sbit sw_dir1_dir at     TRISA4_bit;
sbit sw_puls1 at         RB4_bit;
sbit sw_puls1_dir at     TRISB4_bit;

sbit sw_dir2 at         Ra5_bit;
sbit sw_dir2_dir at     TRISA5_bit;
sbit sw_puls2 at         RB5_bit;
sbit sw_puls2_dir at     TRISB5_bit;

bit kk1 , kk2  ;
char state1=0 , state2=0 ,puls1=0 , puls2=0 , negative1=0 , negative2=0 ;
unsigned int time_stop1 , time_stop2;
short value1=0 , value2=0;
char *motor_stepper;

void stepper_motor_lift(char *motor_stepper,char no_motor );
void stepper_motor_right(char *motor_stepper,char no_motor);

//Timer0
//Prescaler 1:256; TMR0 Preload = 61; Actual Interrupt Time : 24.96 ms

//Place/Copy this part in declaration section
void InitTimer0()
{
   TMR0  = 61;
}


void interrupt()
{
  if(RBIF_bit==1)
     {
      RBIF_bit=0;
      if(sw_puls1==1)kk1=1;
      if(sw_puls2==1)kk2=1;
     }
  if (TMR0IF_bit)
  {
    TMR0IF_bit         = 0;
    TMR0                 = 61;
    //Enter your code here
    time_stop1++;
    time_stop2++;
  }

}
void main()
{
  cmcon=7;
  sw_dir1_dir=1;
  sw_dir2_dir=1;
  sw_puls1_dir=1;
  sw_puls2_dir=1;
  trisb=0xF0;
  portb &=0xF0;
  trisa=0xF0;
  porta &=0xF0;

  InitTimer0();
  OPTION_REG = 0x87;

  INTCON    = 0xA8;
  while(1)
         {
            if(sw_dir1==1)value1=-1;
            else value1=1;

            if(sw_dir2==1)value2=-1;
            else value2=1;

          if(  kk1==1 )
                         {
                            kk1=0;
                            GIE_bit=0;
                            time_stop1=0;
                            if(value1==1)
                                         {
                                          if(puls1>0 && negative1==2){puls1--;state1=2;}
                                          else {puls1++;state1=1; negative1=1;}

                                         }
                            else if(value1==-1)
                                              {
                                               if(puls1>0 && negative1==1){puls1--;state1=1;}
                                               else {puls1++;state1=2; negative1=2;}
                                              }

                                   if(puls1>=8)puls1=0;

                               GIE_bit=1;
                           }

          if(  kk2==1 )
                         {
                            kk2=0;
                            GIE_bit=0;
                            time_stop2=0;
                            if(value2==1)
                                         {
                                          if(puls2>0 && negative2==2){puls2--;state2=2;}
                                          else {puls2++;state2=1; negative2=1;}

                                         }
                                   else if(value2==-1)
                                              {
                                               if(puls2>0 && negative2==1){puls2--;state2=1;}
                                               else {puls2++;state2=2; negative2=2;}
                                              }

                                   if(puls2>=8)puls2=0;

                               GIE_bit=1;
                           }


          if( state1==1)
               {
                state1=0;
                 stepper_motor_lift(&porta,1);
               }
            else if(  state1==2)
               {
                state1=0;
                stepper_motor_right(&porta,1);
               }


           if( state2==1)
               {
                state2=0;
                stepper_motor_lift(&portb,2);
               }
            else if(  state2==2)
               {
                state2=0;
                stepper_motor_right(&portb,2);
               }

           if(time_stop1> 20 ) // 1sec=1000ms ==> 1000/50=20
                 {
                  porta &=0xF0 ;// OFF motor
                 }

            if(time_stop2> 20 ) // 1sec=1000ms ==> 1000/50=20
                 {
                   portb &=0xF0 ;// OFF motor
                 }
         }
}

//*******************************************//
void stepper_motor_lift(char *motor_stepper,char no_motor )
{
 char pluses1=0;
 *motor_stepper &=0xF0;
 if(no_motor==1)pluses1=puls1;
 else if(no_motor==2)pluses1=puls2;
 switch(pluses1)
             {
              case 0  :*motor_stepper  |=9; break;
              case 1  :*motor_stepper |=1;break; //-45
              case 2  :*motor_stepper |=3;break; //-90
              case 3  :*motor_stepper |=2;break;  //-135
              case 4  :*motor_stepper |=6;break; //-180
              case 5  :*motor_stepper |=4;break; //-225
              case 6  :*motor_stepper |=12;break;//-270
              case 7  :*motor_stepper |=8;break;//-315

              default:break;
             }

}

//*********************************************//
void stepper_motor_right(char *motor_stepper,char no_motor)
{
  char Pulses2=0;
  *motor_stepper &=0xF0;
  if(no_motor==1)Pulses2=puls1;
  else if(no_motor==2)Pulses2=puls2;
   switch(Pulses2)
                 {
                             case 0:*motor_stepper |=9;break; //0
                             case 1:*motor_stepper |=8;break; //45
                             case 2:*motor_stepper |=12;break; //90
                             case 3:*motor_stepper |=4;break;  //135
                             case 4:*motor_stepper |=6;break; //180
                             case 5:*motor_stepper |=2;break; //225
                             case 6:*motor_stepper |=3;break; //270
                             case 7:*motor_stepper |=1;break;//315

                             default:break;
                 }

 }