123

Dependencies:   mbed

main.cpp

Committer:
Amber77
Date:
2017-09-20
Revision:
0:3c119cb9fc49

File content as of revision 0:3c119cb9fc49:

/* https://developer.mbed.org/users/andrewrussell/code/Servo/ */
/* JS using 3.3V */
#include "mbed.h"


DigitalOut LiftingStopRun(PA_15);
DigitalOut F_R(PA_14);  // CW/CCW
DigitalOut H_F(PA_13);

DigitalIn LimitSwitchUp(PB_15,PullUp);
DigitalIn LimitSwitchDown(PB_14,PullUp);
//DigitalIn TIM(D6);

DigitalOut myled(LED1);
DigitalIn mybutton(USER_BUTTON);
int control_mybutton=0;
int Control_LiftingStopRun=1;
int Control_F_R=1;

int main() 
{
    int limitSwitchUp;
    int limitSwitchDown;
    
    
    
    H_F.write(1);
    while(1)
    {   
        limitSwitchUp = LimitSwitchUp.read();
        limitSwitchDown = LimitSwitchDown.read();
        //if (mybutton == 1)
//        {
//            printf("Amber01 \n");
//        }
//        if (mybutton == 0)
//        {
//            if(control_mybutton == 0)
//            {
//                printf("Amber02\n");
//            }
//            else if(control_mybutton == 1)
//            {
//                printf("Amber03\n");
//            }
//            control_mybutton = 1-control_mybutton;
//            printf("%d \n",control_mybutton);
//            wait(0.2);
        //if (mybutton == 1)
//        {
//            Control_LiftingStopRun=1;
//            Control_F_R=1;
//            
//            LiftingStopRun.write(Control_LiftingStopRun);  // 0:Run  1:Stop
//            F_R.write(Control_F_R);  //  0:turn down  1:turn up
//            printf("Amber01\n");
//        }
        if (mybutton == 0)
        {
            Control_LiftingStopRun=0;
            LiftingStopRun.write(Control_LiftingStopRun);  // 0:Run  1:Stop
            F_R.write(Control_F_R);  //  0:turn down  1:turn up
            printf("Amber02\n");
            Control_F_R=1-Control_F_R;
            printf("%d \n",Control_F_R);
            wait(3);
        }
        if(limitSwitchUp == 0)
        {
            LiftingStopRun.write(1);  // 0:Run  1:Stop
            F_R.write(1);  //  0:turn down  1:turn up
            printf("Amber03\n");
        }
        if(limitSwitchDown == 0)
        {
            LiftingStopRun.write(1);  // 0:Run  1:Stop
            F_R.write(0);  //  0:turn down  1:turn up
            printf("Amber04\n");
        }
    
        
        //LiftingStopRun.write(1);
//        F_R.write(1);
//        limitSwitchUp = LimitSwitchUp.read();
//        limitSwitchDown = LimitSwitchDown.read();
//        if(!mybutton)
//        {
//            control_mybutton=1-control_mybutton;
//            Control_LiftingStopRun=0;
//            Control_F_R=1;
//            
//            LiftingStopRun.write(Control_LiftingStopRun);  // 0:Run  1:Stop
//            F_R.write(Control_F_R);  //  0:turn down  1:turn up
//            
//            if(limitSwitchUp == 0)
//            {
//                Control_LiftingStopRun=1;
//                Control_F_R=1;
//                LiftingStopRun.write(Control_LiftingStopRun);  // 0:Run  1:Stop
//                F_R.write(Control_F_R);  //  0:turn down  1:turn up
//            }
//        }
//        if(mybutton == 1-control_mybutton)
//        {
//            control_mybutton=control_mybutton;
//            Control_LiftingStopRun=0;
//            Control_F_R=0;
//            LiftingStopRun.write(Control_LiftingStopRun);  // 0:Run  1:Stop
//            F_R.write(Control_F_R);  //  0:turn down  1:turn up
//            if(limitSwitchDown == 0)
//            {
//                Control_LiftingStopRun=1;
//                Control_F_R=0;
//                LiftingStopRun.write(Control_LiftingStopRun);  // 0:Run  1:Stop
//                F_R.write(Control_F_R);  //  0:turn down  1:turn up
//            }         
//        }       
    
        //printf(" %d | %d\n", limitSwitchUp,limitSwitchDown);
//        printf(" %d \n", mybutton);
        wait_ms(0.1);
    }    
}