han seungchun / Mbed OS 0820_2

22

Dependencies:   DISCO_L475VG_IOT01A_wifi

MotorControl.cpp@1:98939393d0db, 2019-08-20 (annotated)

Committer:
ascension2
Date:
Tue Aug 20 10:45:16 2019 +0000
Revision:
1:98939393d0db
Parent:
0:dc1150daf908 
33

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 1:98939393d0db 13
ascension2 0:dc1150daf908 14 void MotorControl();
ascension2 1:98939393d0db 15
ascension2 1:98939393d0db 16 void motor1Stop();
ascension2 1:98939393d0db 17 void motor1CW(float speed);
ascension2 1:98939393d0db 18 void motor1CCW(float speed);
ascension2 1:98939393d0db 19
ascension2 1:98939393d0db 20 void motor2Stop();
ascension2 1:98939393d0db 21 void motor2CW(float speed);
ascension2 1:98939393d0db 22 void motor2CCW(float speed);
ascension2 0:dc1150daf908 23
ascension2 0:dc1150daf908 24
ascension2 0:dc1150daf908 25 void MotorControl()
ascension2 0:dc1150daf908 26 {
ascension2 0:dc1150daf908 27
ascension2 0:dc1150daf908 28 }
ascension2 0:dc1150daf908 29
ascension2 1:98939393d0db 30 void motor1CW(float speed)
ascension2 0:dc1150daf908 31 {
ascension2 1:98939393d0db 32 motor1_state=0;
ascension2 0:dc1150daf908 33 M1_a=1;
ascension2 0:dc1150daf908 34 M1_b=0;
ascension2 0:dc1150daf908 35 M1_en.write((speed/100));
ascension2 0:dc1150daf908 36 //wait(1);
ascension2 0:dc1150daf908 37 //motorStop();
ascension2 0:dc1150daf908 38 }
ascension2 0:dc1150daf908 39
ascension2 1:98939393d0db 40 void motor1CCW(float speed)
ascension2 0:dc1150daf908 41 {
ascension2 1:98939393d0db 42 motor1_state=1;
ascension2 0:dc1150daf908 43 M1_a=0;
ascension2 0:dc1150daf908 44 M1_b=1;
ascension2 0:dc1150daf908 45 M1_en.write((speed/100));
ascension2 0:dc1150daf908 46 //wait(1);
ascension2 0:dc1150daf908 47 //motorStop();
ascension2 0:dc1150daf908 48 }
ascension2 0:dc1150daf908 49
ascension2 1:98939393d0db 50 void motor1Stop()
ascension2 0:dc1150daf908 51 {
ascension2 0:dc1150daf908 52 M1_a=0;
ascension2 0:dc1150daf908 53 M1_b=0;
ascension2 1:98939393d0db 54 }
ascension2 1:98939393d0db 55 void motor2CW(float speed)
ascension2 1:98939393d0db 56 {
ascension2 1:98939393d0db 57 motor2_state=0;
ascension2 1:98939393d0db 58 M2_a=1;
ascension2 1:98939393d0db 59 M2_b=0;
ascension2 1:98939393d0db 60 M2_en.write((speed/100));
ascension2 1:98939393d0db 61 //wait(1);
ascension2 1:98939393d0db 62 //motorStop();
ascension2 1:98939393d0db 63 }
ascension2 1:98939393d0db 64
ascension2 1:98939393d0db 65 void motor2CCW(float speed)
ascension2 1:98939393d0db 66 {
ascension2 1:98939393d0db 67 motor2_state=1;
ascension2 1:98939393d0db 68 M2_a=0;
ascension2 1:98939393d0db 69 M2_b=1;
ascension2 1:98939393d0db 70 M2_en.write((speed/100));
ascension2 1:98939393d0db 71
ascension2 1:98939393d0db 72 }
ascension2 1:98939393d0db 73
ascension2 1:98939393d0db 74 void motor2Stop()
ascension2 1:98939393d0db 75 {
ascension2 1:98939393d0db 76 M2_a=0;
ascension2 1:98939393d0db 77 M2_b=0;
ascension2 0:dc1150daf908 78 }