Amber Tang / Mbed 2 deprecated testLimitSwitch_Lifting_20170819

123

Dependencies:   mbed

main.cpp@0:3c119cb9fc49, 2017-09-20 (annotated)

Committer:
Amber77
Date:
Wed Sep 20 20:36:02 2017 +0000
Revision:
0:3c119cb9fc49
20170921

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Amber77 0:3c119cb9fc49 1 /* https://developer.mbed.org/users/andrewrussell/code/Servo/ */
Amber77 0:3c119cb9fc49 2 /* JS using 3.3V */
Amber77 0:3c119cb9fc49 3 #include "mbed.h"
Amber77 0:3c119cb9fc49 4
Amber77 0:3c119cb9fc49 5
Amber77 0:3c119cb9fc49 6 DigitalOut LiftingStopRun(PA_15);
Amber77 0:3c119cb9fc49 7 DigitalOut F_R(PA_14); // CW/CCW
Amber77 0:3c119cb9fc49 8 DigitalOut H_F(PA_13);
Amber77 0:3c119cb9fc49 9
Amber77 0:3c119cb9fc49 10 DigitalIn LimitSwitchUp(PB_15,PullUp);
Amber77 0:3c119cb9fc49 11 DigitalIn LimitSwitchDown(PB_14,PullUp);
Amber77 0:3c119cb9fc49 12 //DigitalIn TIM(D6);
Amber77 0:3c119cb9fc49 13
Amber77 0:3c119cb9fc49 14 DigitalOut myled(LED1);
Amber77 0:3c119cb9fc49 15 DigitalIn mybutton(USER_BUTTON);
Amber77 0:3c119cb9fc49 16 int control_mybutton=0;
Amber77 0:3c119cb9fc49 17 int Control_LiftingStopRun=1;
Amber77 0:3c119cb9fc49 18 int Control_F_R=1;
Amber77 0:3c119cb9fc49 19
Amber77 0:3c119cb9fc49 20 int main()
Amber77 0:3c119cb9fc49 21 {
Amber77 0:3c119cb9fc49 22 int limitSwitchUp;
Amber77 0:3c119cb9fc49 23 int limitSwitchDown;
Amber77 0:3c119cb9fc49 24
Amber77 0:3c119cb9fc49 25
Amber77 0:3c119cb9fc49 26
Amber77 0:3c119cb9fc49 27 H_F.write(1);
Amber77 0:3c119cb9fc49 28 while(1)
Amber77 0:3c119cb9fc49 29 {
Amber77 0:3c119cb9fc49 30 limitSwitchUp = LimitSwitchUp.read();
Amber77 0:3c119cb9fc49 31 limitSwitchDown = LimitSwitchDown.read();
Amber77 0:3c119cb9fc49 32 //if (mybutton == 1)
Amber77 0:3c119cb9fc49 33 // {
Amber77 0:3c119cb9fc49 34 // printf("Amber01 \n");
Amber77 0:3c119cb9fc49 35 // }
Amber77 0:3c119cb9fc49 36 // if (mybutton == 0)
Amber77 0:3c119cb9fc49 37 // {
Amber77 0:3c119cb9fc49 38 // if(control_mybutton == 0)
Amber77 0:3c119cb9fc49 39 // {
Amber77 0:3c119cb9fc49 40 // printf("Amber02\n");
Amber77 0:3c119cb9fc49 41 // }
Amber77 0:3c119cb9fc49 42 // else if(control_mybutton == 1)
Amber77 0:3c119cb9fc49 43 // {
Amber77 0:3c119cb9fc49 44 // printf("Amber03\n");
Amber77 0:3c119cb9fc49 45 // }
Amber77 0:3c119cb9fc49 46 // control_mybutton = 1-control_mybutton;
Amber77 0:3c119cb9fc49 47 // printf("%d \n",control_mybutton);
Amber77 0:3c119cb9fc49 48 // wait(0.2);
Amber77 0:3c119cb9fc49 49 //if (mybutton == 1)
Amber77 0:3c119cb9fc49 50 // {
Amber77 0:3c119cb9fc49 51 // Control_LiftingStopRun=1;
Amber77 0:3c119cb9fc49 52 // Control_F_R=1;
Amber77 0:3c119cb9fc49 53 //
Amber77 0:3c119cb9fc49 54 // LiftingStopRun.write(Control_LiftingStopRun); // 0:Run 1:Stop
Amber77 0:3c119cb9fc49 55 // F_R.write(Control_F_R); // 0:turn down 1:turn up
Amber77 0:3c119cb9fc49 56 // printf("Amber01\n");
Amber77 0:3c119cb9fc49 57 // }
Amber77 0:3c119cb9fc49 58 if (mybutton == 0)
Amber77 0:3c119cb9fc49 59 {
Amber77 0:3c119cb9fc49 60 Control_LiftingStopRun=0;
Amber77 0:3c119cb9fc49 61 LiftingStopRun.write(Control_LiftingStopRun); // 0:Run 1:Stop
Amber77 0:3c119cb9fc49 62 F_R.write(Control_F_R); // 0:turn down 1:turn up
Amber77 0:3c119cb9fc49 63 printf("Amber02\n");
Amber77 0:3c119cb9fc49 64 Control_F_R=1-Control_F_R;
Amber77 0:3c119cb9fc49 65 printf("%d \n",Control_F_R);
Amber77 0:3c119cb9fc49 66 wait(3);
Amber77 0:3c119cb9fc49 67 }
Amber77 0:3c119cb9fc49 68 if(limitSwitchUp == 0)
Amber77 0:3c119cb9fc49 69 {
Amber77 0:3c119cb9fc49 70 LiftingStopRun.write(1); // 0:Run 1:Stop
Amber77 0:3c119cb9fc49 71 F_R.write(1); // 0:turn down 1:turn up
Amber77 0:3c119cb9fc49 72 printf("Amber03\n");
Amber77 0:3c119cb9fc49 73 }
Amber77 0:3c119cb9fc49 74 if(limitSwitchDown == 0)
Amber77 0:3c119cb9fc49 75 {
Amber77 0:3c119cb9fc49 76 LiftingStopRun.write(1); // 0:Run 1:Stop
Amber77 0:3c119cb9fc49 77 F_R.write(0); // 0:turn down 1:turn up
Amber77 0:3c119cb9fc49 78 printf("Amber04\n");
Amber77 0:3c119cb9fc49 79 }
Amber77 0:3c119cb9fc49 80
Amber77 0:3c119cb9fc49 81
Amber77 0:3c119cb9fc49 82 //LiftingStopRun.write(1);
Amber77 0:3c119cb9fc49 83 // F_R.write(1);
Amber77 0:3c119cb9fc49 84 // limitSwitchUp = LimitSwitchUp.read();
Amber77 0:3c119cb9fc49 85 // limitSwitchDown = LimitSwitchDown.read();
Amber77 0:3c119cb9fc49 86 // if(!mybutton)
Amber77 0:3c119cb9fc49 87 // {
Amber77 0:3c119cb9fc49 88 // control_mybutton=1-control_mybutton;
Amber77 0:3c119cb9fc49 89 // Control_LiftingStopRun=0;
Amber77 0:3c119cb9fc49 90 // Control_F_R=1;
Amber77 0:3c119cb9fc49 91 //
Amber77 0:3c119cb9fc49 92 // LiftingStopRun.write(Control_LiftingStopRun); // 0:Run 1:Stop
Amber77 0:3c119cb9fc49 93 // F_R.write(Control_F_R); // 0:turn down 1:turn up
Amber77 0:3c119cb9fc49 94 //
Amber77 0:3c119cb9fc49 95 // if(limitSwitchUp == 0)
Amber77 0:3c119cb9fc49 96 // {
Amber77 0:3c119cb9fc49 97 // Control_LiftingStopRun=1;
Amber77 0:3c119cb9fc49 98 // Control_F_R=1;
Amber77 0:3c119cb9fc49 99 // LiftingStopRun.write(Control_LiftingStopRun); // 0:Run 1:Stop
Amber77 0:3c119cb9fc49 100 // F_R.write(Control_F_R); // 0:turn down 1:turn up
Amber77 0:3c119cb9fc49 101 // }
Amber77 0:3c119cb9fc49 102 // }
Amber77 0:3c119cb9fc49 103 // if(mybutton == 1-control_mybutton)
Amber77 0:3c119cb9fc49 104 // {
Amber77 0:3c119cb9fc49 105 // control_mybutton=control_mybutton;
Amber77 0:3c119cb9fc49 106 // Control_LiftingStopRun=0;
Amber77 0:3c119cb9fc49 107 // Control_F_R=0;
Amber77 0:3c119cb9fc49 108 // LiftingStopRun.write(Control_LiftingStopRun); // 0:Run 1:Stop
Amber77 0:3c119cb9fc49 109 // F_R.write(Control_F_R); // 0:turn down 1:turn up
Amber77 0:3c119cb9fc49 110 // if(limitSwitchDown == 0)
Amber77 0:3c119cb9fc49 111 // {
Amber77 0:3c119cb9fc49 112 // Control_LiftingStopRun=1;
Amber77 0:3c119cb9fc49 113 // Control_F_R=0;
Amber77 0:3c119cb9fc49 114 // LiftingStopRun.write(Control_LiftingStopRun); // 0:Run 1:Stop
Amber77 0:3c119cb9fc49 115 // F_R.write(Control_F_R); // 0:turn down 1:turn up
Amber77 0:3c119cb9fc49 116 // }
Amber77 0:3c119cb9fc49 117 // }
Amber77 0:3c119cb9fc49 118
Amber77 0:3c119cb9fc49 119 //printf(" %d | %d\n", limitSwitchUp,limitSwitchDown);
Amber77 0:3c119cb9fc49 120 // printf(" %d \n", mybutton);
Amber77 0:3c119cb9fc49 121 wait_ms(0.1);
Amber77 0:3c119cb9fc49 122 }
Amber77 0:3c119cb9fc49 123 }