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;
}