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 Lab3_experiment_example jumping_leg_clicky
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();
}