22

Dependencies:   DISCO_L475VG_IOT01A_wifi

MotorControl.cpp

Committer:
ascension2
Date:
2019-08-20
Revision:
1:98939393d0db
Parent:
0:dc1150daf908

File content as of revision 1:98939393d0db:

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

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=0;
M1_a=1;
M1_b=0;
M1_en.write((speed/100));
//wait(1);
//motorStop();
}

void motor1CCW(float speed)
{
motor1_state=1;
M1_a=0;
M1_b=1;
M1_en.write((speed/100));
//wait(1);
//motorStop();
}

void motor1Stop()
{
M1_a=0;
M1_b=0;
}
void motor2CW(float speed)
{
motor2_state=0;
M2_a=1;
M2_b=0;
M2_en.write((speed/100));
//wait(1);
//motorStop();
}

void motor2CCW(float speed)
{
motor2_state=1;
M2_a=0;
M2_b=1;
M2_en.write((speed/100));

}

void motor2Stop()
{
M2_a=0;
M2_b=0;
}