collab/pb-hal
git clone https://git.julia.blue/collab/pb-hal
9cbe263
tof
1#include <pigpio.h> 2#include <cmath> 3#include "../inc/motor.h" 4 5using namespace std ; 6 7const double DEADZONE = .05 ;// for speed not encoder ticks 8const int FREQENCY = 440 ;// gotto make sure our motors are in tune 9 10L298N ::L298N (int m1pin ,int m2pin ,int pwmpin ,int encA ,int encB ) 11 :Motor (encA ,encB ),m1 (m1pin ),m2 (m2pin ),pwm (pwmpin ) { 12gpioSetMode (m1 ,PI_OUTPUT ); 13gpioSetMode (m2 ,PI_OUTPUT ); 14gpioSetMode (pwm ,PI_OUTPUT ); 15gpioSetPWMfrequency (pwm ,FREQENCY );// lower freq gives lower min speed 16gpioSetPWMrange (pwm ,1000 );// not sure why we'd want a small range 17} 18 19void L298N ::set (double speed ) { 20if (speed > DEADZONE ) { 21gpioWrite (m1 ,1 ); 22gpioWrite (m2 ,0 ); 23 }else if (speed < - DEADZONE ) { 24gpioWrite (m1 ,0 ); 25gpioWrite (m2 ,1 ); 26 }else { 27gpioWrite (m1 ,0 ); 28gpioWrite (m2 ,0 ); 29 } 30gpioPWM (pwm ,abs (speed )* gpioGetPWMrange (pwm )); 31} 32 33void L298N ::stop () { 34set (0 ); 35gpioWrite (m1 ,0 ); 36gpioWrite (m2 ,0 ); 37} 38 39L298N ::~L298N () { 40stop (); 41} 42 43DRV ::DRV (int pwmpin1 ,int pwmpin2 ,int encA ,int encB ) 44 :Motor (encA ,encB ),pwm1 (pwmpin1 ),pwm2 (pwmpin2 ) { 45gpioSetMode (pwm1 ,PI_OUTPUT ); 46gpioSetPWMfrequency (pwm1 ,440 ); 47gpioSetPWMrange (pwm1 ,1000 ); 48gpioSetMode (pwm2 ,PI_OUTPUT ); 49gpioSetPWMfrequency (pwm2 ,440 ); 50gpioSetPWMrange (pwm2 ,1000 ); 51} 52 53void DRV ::set (double speed ) { 54double next1 ,next2 ; 55if (speed > DEADZONE ) { 56next1 = pwm1 ; 57next2 = pwm2 ; 58 }else if (speed < - DEADZONE ) { 59next1 = pwm2 ; 60next2 = pwm1 ; 61 }else { 62stop (); 63return ; 64 } 65gpioPWM (next1 ,abs (speed )* gpioGetPWMrange (pwm1 )); 66gpioPWM (next2 ,0 ); 67} 68 69void DRV ::stop () { 70//todo: try 0's for sleep instead of break 71gpioWrite (pwm1 ,1 ); 72gpioWrite (pwm2 ,1 ); 73} 74 75DRV ::~DRV () { 76stop (); 77}