han seungchun / Mbed OS 0820_3

33

Dependencies:   DISCO_L475VG_IOT01A_wifi

MotorControl.cpp@3:32b328935a54, 2019-08-21 (annotated)

Committer:
ascension2
Date:
Wed Aug 21 08:45:28 2019 +0000
Revision:
3:32b328935a54
Parent:
2:a460007a35c7 
55

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ascension2 0:dc1150daf908 1 #include "mbed.h"
ascension2 0:dc1150daf908 2 ////////// motor (window) //////////
ascension2 0:dc1150daf908 3 DigitalOut M1_a(A1);
ascension2 0:dc1150daf908 4 DigitalOut M1_b(A2);
ascension2 0:dc1150daf908 5 PwmOut M1_en(D3);
ascension2 0:dc1150daf908 6 ////////// motor (blind) //////////
ascension2 0:dc1150daf908 7 DigitalOut M2_a(A3);
ascension2 0:dc1150daf908 8 DigitalOut M2_b(A4);
ascension2 0:dc1150daf908 9 PwmOut M2_en(D4);
ascension2 0:dc1150daf908 10
ascension2 1:98939393d0db 11 int motor1_state;
ascension2 1:98939393d0db 12 int motor2_state;
ascension2 2:a460007a35c7 13 int window_state;
ascension2 2:a460007a35c7 14 int blind_state;
ascension2 0:dc1150daf908 15 void MotorControl();
ascension2 1:98939393d0db 16
ascension2 1:98939393d0db 17 void motor1Stop();
ascension2 1:98939393d0db 18 void motor1CW(float speed);
ascension2 1:98939393d0db 19 void motor1CCW(float speed);
ascension2 1:98939393d0db 20
ascension2 1:98939393d0db 21 void motor2Stop();
ascension2 1:98939393d0db 22 void motor2CW(float speed);
ascension2 1:98939393d0db 23 void motor2CCW(float speed);
ascension2 0:dc1150daf908 24
ascension2 0:dc1150daf908 25
ascension2 0:dc1150daf908 26 void MotorControl()
ascension2 0:dc1150daf908 27 {
ascension2 0:dc1150daf908 28
ascension2 0:dc1150daf908 29 }
ascension2 0:dc1150daf908 30
ascension2 1:98939393d0db 31 void motor1CW(float speed)
ascension2 0:dc1150daf908 32 {
ascension2 2:a460007a35c7 33 motor1_state=1;
ascension2 2:a460007a35c7 34 window_state=1;
ascension2 0:dc1150daf908 35 M1_a=1;
ascension2 0:dc1150daf908 36 M1_b=0;
ascension2 0:dc1150daf908 37 M1_en.write((speed/100));
ascension2 3:32b328935a54 38
ascension2 3:32b328935a54 39 int i ;
ascension2 3:32b328935a54 40 for(i=0; i<20000000;i++){ }
ascension2 2:a460007a35c7 41 motor1Stop();
ascension2 0:dc1150daf908 42 }
ascension2 0:dc1150daf908 43
ascension2 1:98939393d0db 44 void motor1CCW(float speed)
ascension2 0:dc1150daf908 45 {
ascension2 2:a460007a35c7 46 motor1_state=0;
ascension2 2:a460007a35c7 47 window_state=0;
ascension2 0:dc1150daf908 48 M1_a=0;
ascension2 0:dc1150daf908 49 M1_b=1;
ascension2 0:dc1150daf908 50 M1_en.write((speed/100));
ascension2 3:32b328935a54 51
ascension2 3:32b328935a54 52 int i ;
ascension2 3:32b328935a54 53 for(i=0; i<20000000;i++){ }
ascension2 2:a460007a35c7 54 motor1Stop();
ascension2 0:dc1150daf908 55 }
ascension2 0:dc1150daf908 56
ascension2 1:98939393d0db 57 void motor1Stop()
ascension2 0:dc1150daf908 58 {
ascension2 0:dc1150daf908 59 M1_a=0;
ascension2 0:dc1150daf908 60 M1_b=0;
ascension2 2:a460007a35c7 61 motor1_state=2;
ascension2 1:98939393d0db 62 }
ascension2 1:98939393d0db 63 void motor2CW(float speed)
ascension2 1:98939393d0db 64 {
ascension2 2:a460007a35c7 65 motor2_state=1;
ascension2 2:a460007a35c7 66 blind_state=1;
ascension2 1:98939393d0db 67 M2_a=1;
ascension2 1:98939393d0db 68 M2_b=0;
ascension2 1:98939393d0db 69 M2_en.write((speed/100));
ascension2 3:32b328935a54 70
ascension2 3:32b328935a54 71
ascension2 3:32b328935a54 72 int i ;
ascension2 3:32b328935a54 73 for(i=0; i<20000000;i++){ }
ascension2 3:32b328935a54 74 motor1Stop();
ascension2 1:98939393d0db 75 }
ascension2 1:98939393d0db 76
ascension2 1:98939393d0db 77 void motor2CCW(float speed)
ascension2 1:98939393d0db 78 {
ascension2 2:a460007a35c7 79 motor2_state=0;
ascension2 2:a460007a35c7 80 blind_state=0;
ascension2 1:98939393d0db 81 M2_a=0;
ascension2 1:98939393d0db 82 M2_b=1;
ascension2 3:32b328935a54 83 int i ;
ascension2 3:32b328935a54 84 for(i=0; i<20000000;i++){ }
ascension2 3:32b328935a54 85 motor1Stop();
ascension2 1:98939393d0db 86
ascension2 1:98939393d0db 87 }
ascension2 1:98939393d0db 88
ascension2 1:98939393d0db 89 void motor2Stop()
ascension2 1:98939393d0db 90 {
ascension2 1:98939393d0db 91 M2_a=0;
ascension2 1:98939393d0db 92 M2_b=0;
ascension2 2:a460007a35c7 93 motor2_state=2;
ascension2 0:dc1150daf908 94 }