collab/mm20
git clone https://git.julia.blue/collab/mm20
79f4ff4
algorithms
1#include "motors.h" 2#include "tivaware/gpio.h" 3#include "tivaware/hw_memmap.h" 4#include "tivaware/pin_map.h" 5#include "tivaware/qei.h" 6#include "tivaware/rom.h" 7#include "tivaware/sysctl.h" 8 9// TODO: init pwm for drivers 10void init_motors () { 11ROM_SysCtlPeripheralEnable (SYSCTL_PERIPH_QEI0 ); 12ROM_SysCtlPeripheralEnable (SYSCTL_PERIPH_QEI1 ); 13ROM_SysCtlPeripheralEnable (SYSCTL_PERIPH_GPIOC ); 14ROM_SysCtlPeripheralEnable (SYSCTL_PERIPH_GPIOD ); 15ROM_GPIOPinConfigure (GPIO_PD6_PHA0 ); 16ROM_GPIOPinConfigure (GPIO_PD7_PHB0 ); 17ROM_GPIOPinConfigure (GPIO_PC5_PHA1 ); 18ROM_GPIOPinConfigure (GPIO_PC6_PHB1 ); 19ROM_GPIOPinTypeQEI (GPIO_PORTD_BASE ,GPIO_PIN_6 |GPIO_PIN_7 ); 20ROM_GPIOPinTypeQEI (GPIO_PORTC_BASE ,GPIO_PIN_5 |GPIO_PIN_6 ); 21ROM_QEIConfigure (QEI0_BASE ,QEI_CONFIG_CAPTURE_A_B |QEI_CONFIG_SWAP , 22UINT32_MAX ); 23ROM_QEIConfigure (QEI1_BASE ,QEI_CONFIG_CAPTURE_A_B |QEI_CONFIG_NO_SWAP , 24UINT32_MAX ); 25ROM_QEIVelocityConfigure (QEI0_BASE ,QEI_VELDIV_1 ,VELOCITY_PERIOD ); 26ROM_QEIVelocityConfigure (QEI1_BASE ,QEI_VELDIV_1 ,VELOCITY_PERIOD ); 27ROM_QEIEnable (QEI0_BASE ); 28ROM_QEIEnable (QEI1_BASE ); 29ROM_QEIVelocityEnable (QEI0_BASE ); 30ROM_QEIVelocityEnable (QEI1_BASE ); 31} 32 33int32_t left_pos (void ) { 34return ROM_QEIPositionGet (QEI0_BASE ); 35} 36 37int32_t right_pos (void ) { 38return ROM_QEIPositionGet (QEI1_BASE ); 39} 40 41uint32_t left_speed (void ) { 42return ROM_QEIVelocityGet (QEI0_BASE ); 43} 44uint32_t right_speed (void ) { 45return ROM_QEIVelocityGet (QEI1_BASE ); 46} 47 48void reset_enc (void ) { 49ROM_QEIPositionSet (QEI0_BASE ,0 ); 50ROM_QEIPositionSet (QEI1_BASE ,0 ); 51} 52 53void set_left (float speed ) { 54// TODO 55} 56 57void set_right (float speed ) { 58// TODO 59}