33
Dependencies: DISCO_L475VG_IOT01A_wifi
MotorControl.cpp
- Committer:
- ascension2
- Date:
- 2019-08-21
- Revision:
- 3:32b328935a54
- Parent:
- 2:a460007a35c7
File content as of revision 3:32b328935a54:
#include "mbed.h" ////////// motor (window) ////////// DigitalOut M1_a(A1); DigitalOut M1_b(A2); PwmOut M1_en(D3); ////////// motor (blind) ////////// DigitalOut M2_a(A3); DigitalOut M2_b(A4); PwmOut M2_en(D4); int motor1_state; int motor2_state; int window_state; int blind_state; void MotorControl(); void motor1Stop(); void motor1CW(float speed); void motor1CCW(float speed); void motor2Stop(); void motor2CW(float speed); void motor2CCW(float speed); void MotorControl() { } void motor1CW(float speed) { motor1_state=1; window_state=1; M1_a=1; M1_b=0; M1_en.write((speed/100)); int i ; for(i=0; i<20000000;i++){ } motor1Stop(); } void motor1CCW(float speed) { motor1_state=0; window_state=0; M1_a=0; M1_b=1; M1_en.write((speed/100)); int i ; for(i=0; i<20000000;i++){ } motor1Stop(); } void motor1Stop() { M1_a=0; M1_b=0; motor1_state=2; } void motor2CW(float speed) { motor2_state=1; blind_state=1; M2_a=1; M2_b=0; M2_en.write((speed/100)); int i ; for(i=0; i<20000000;i++){ } motor1Stop(); } void motor2CCW(float speed) { motor2_state=0; blind_state=0; M2_a=0; M2_b=1; int i ; for(i=0; i<20000000;i++){ } motor1Stop(); } void motor2Stop() { M2_a=0; M2_b=0; motor2_state=2; }