Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Dependents: experiment_example motor_shield_example Position_ctrl Lab3_experiment_example ... more
MotorShield.cpp
- Committer:
- elijahsj
- Date:
- 2020-08-26
- Revision:
- 5:d2dffc88e94d
- Parent:
- 4:2b45973bdc67
- Child:
- 7:e3a2ade56b79
File content as of revision 5:d2dffc88e94d:
/* Library to interface with 2.74 Motor Shield
** Uses low level HAL libraries to enable high speed PWM
** Use as follows:
** - Create shield object and specify PWM period for the motors
** - Set the duty cycle and direction for each motor
*/
#include "mbed.h"
#include "MotorShield.h"
#include "HardwareSetup.h"
MotorShield::MotorShield(int periodTicks) {
periodTickVal = periodTicks;
init();
}
void MotorShield::init() {
/** Initial config for the STM32H743 **/
initHardware(periodTickVal); // Setup PWM
wait_us(100);
}
void MotorShield::motorAWrite(float duty_cycle, int direction) {
int tick = (int)(periodTickVal * duty_cycle);
if (direction){
TIM15->CCR2 = tick;
TIM15->CCR1 = 0;
}
else {
TIM15->CCR2 = 0;
TIM15->CCR1 = tick;
}
}
void MotorShield::motorBWrite(float duty_cycle, int direction) {
int tick = (int)(periodTickVal * duty_cycle);
if (direction){
TIM12->CCR2 = tick;
TIM12->CCR1 = 0;
}
else {
TIM12->CCR2 = 0;
TIM12->CCR1 = tick;
}
}
void MotorShield::motorCWrite(float duty_cycle, int direction) {
int tick = (int)(periodTickVal * duty_cycle);
if (direction){
TIM13->CCR1 = 0;
TIM14->CCR1 = tick;
}
else {
TIM13->CCR1 = tick;
TIM14->CCR1 = 0;
}
}
void MotorShield::motorDWrite(float duty_cycle, int direction) {
int tick = (int)(periodTickVal * duty_cycle);
if (direction){
TIM16->CCR1 = tick;
TIM17->CCR1 = 0;
}
else {
TIM16->CCR1 = 0;
TIM17->CCR1 = tick;
}
}
void MotorShield::changePeriod(int periodTicks){
periodTickVal = periodTicks;
init();
}