PlayBack
Dependencies: TPixy-Interface
Fork of ObjectFollower by
Diff: Drivers/motor_driver_l.cpp
- Revision:
- 9:fe56b888985c
- Child:
- 13:2a00b7a6f4bd
diff -r a0890fa79084 -r fe56b888985c Drivers/motor_driver_l.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/Drivers/motor_driver_l.cpp Fri Feb 23 20:58:34 2018 +0000 @@ -0,0 +1,112 @@ +/******************************************************************************/ +// ECE4333 +// LAB Partner 1: Ahmed Sobhy - ID: 3594449 +// LAB Partner 2: Brandon Kingman - ID: 3470444 +// Project: Autonomous Robot Design +// Instructor: Prof. Chris Diduch +/******************************************************************************/ +// filename: motor_driver.cpp +// file content description: +// * function to initialize the hardware used to control a DC Motor +// * functions to drive to motor in forward, reverse and stop. +/******************************************************************************/ + +#include "mbed.h" +#include "motor_driver_r.h" +#include "motor_driver_l.h" + + + +DigitalOut DirL(p30); // Right motor direction control pin +PwmOut PwmL(p22); // Right motor PWMz + +Mutex SpeedMutexL; + +static motor_state_t motor_status = MOTOR_UNINIT; + + +/******************************************************************************* +* @brief This function initializes the PWM channel to be used to control a DC +* motor +* @param none +* @return motor_state_t the state of the motor driver +*******************************************************************************/ +motor_state_t motorDriver_L_init() +{ + // motor is still uninitialized + motor_status = MOTOR_UNINIT; + + // DC Motor Control Pins + DirL = 0; + PwmL = 0; + + PwmL.period_us(PERIOD_L); // This sets the PWM period in us + + + motor_status = MOTOR_INIT; + + return motor_status; + +} + +/******************************************************************************* +* @brief This function sets the speed and the direction of the DC motor to move +* forward +* @param speed +* @return motor_state_t the state of the motor driver +*******************************************************************************/ +motor_state_t motorDriver_L_forward(int speed) +{ + + if( motor_status != MOTOR_UNINIT ) + { + SpeedMutexL.lock(); + DirL = 0; + PwmL.pulsewidth_us(abs(speed)); + SpeedMutexL.unlock(); + motor_status = MOTOR_FORWARD; + } + + return motor_status; + +} + +/******************************************************************************* +* @brief This function sets the speed and the direction of the DC motor to move +* backwards +* @param speed +* @return motor_state_t the state of the motor driver +*******************************************************************************/ +motor_state_t motorDriver_L_reverse(int speed) +{ + + if( motor_status != MOTOR_UNINIT ) + { + SpeedMutexL.lock(); + DirL = 1; + PwmL.pulsewidth_us(abs(speed)); + SpeedMutexL.unlock(); + motor_status = MOTOR_REVERSE; + } + + return motor_status; + +} + +/******************************************************************************* +* @brief This function stops the motor +* @param none +* @return motor_state_t the state of the motor driver +*******************************************************************************/ +motor_state_t motorDriver_L_stop() +{ + + if( motor_status != MOTOR_UNINIT ) + { + PwmL.pulsewidth_us(0); + motor_status = MOTOR_STOPPED; + } + + return motor_status; + +}