Robot project.
Dependencies: HCSR04 PID QEI mbed
DRV8833.cpp
- Committer:
- srsmitherman
- Date:
- 2013-12-12
- Revision:
- 1:82463f25fd3c
File content as of revision 1:82463f25fd3c:
/* * @file DRV8833.h * @author Oskar Lopez de Gamboa * * @section LICENSE * * Permission is hereby granted, free of charge, to any person obtaining a copy of this software * and associated documentation files (the "Software"), to deal in the Software without restriction, * including without limitation the rights to use, copy, modify, merge, publish, distribute, * sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is * furnished to do so, subject to the following conditions: * * The above copyright notice and this permission notice shall be included in all copies or * substantial portions of the Software. * * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING * BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. * * @section DESCRIPTION * * mbed simple DRV8833 H-bridge motor controller * * * PWM a un puente en H(DRV8833) conectado a los motores. * El comportamiento del driver es el siguiente: * * x_PWM1 x_PWM2 Mode * 0 0 Coast/Fast decay * 0 1 Reverse * 1 0 Forward * 1 1 Brake/slow decay *10/12/2013 */ #include "DRV8833.h" DRV8833::DRV8833(PinName pwm1, PinName pwm2): _pwm1(pwm1), _pwm2(pwm2) { // Set initial condition of PWM _pwm1.period(0.001); _pwm1 = 0; _pwm2.period(0.001); _pwm2 = 0; _period = 0.001; _speed = 0; } void DRV8833::speed(float speed) { _speed = speed; if (speed > 0.0) { _pwm1 = abs(speed); _pwm2 = 0; } else { _pwm1 = 0; _pwm2 = abs(speed); } } void DRV8833::period(float period){ _period = period; _pwm1.period(period); _pwm2.period(period); } void DRV8833::brake(int mode){ if(mode == COAST) { _pwm1 = 0; _pwm2 = 0; } else if(mode == BRAKE) { _pwm1 = 1; _pwm2 = 1; } } float DRV8833::getSpeed(void){ return _speed; } float DRV8833::getPeriod(void){ return _period; }