collab/mm20

git clone https://git.julia.blue/collab/mm20

Joseph RyanAdd encoder initialization79f4ff4

firmware
1.7 KiB59 linesraw
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() {
11    ROM_SysCtlPeripheralEnable(SYSCTL_PERIPH_QEI0);
12    ROM_SysCtlPeripheralEnable(SYSCTL_PERIPH_QEI1);
13    ROM_SysCtlPeripheralEnable(SYSCTL_PERIPH_GPIOC);
14    ROM_SysCtlPeripheralEnable(SYSCTL_PERIPH_GPIOD);
15    ROM_GPIOPinConfigure(GPIO_PD6_PHA0);
16    ROM_GPIOPinConfigure(GPIO_PD7_PHB0);
17    ROM_GPIOPinConfigure(GPIO_PC5_PHA1);
18    ROM_GPIOPinConfigure(GPIO_PC6_PHB1);
19    ROM_GPIOPinTypeQEI(GPIO_PORTD_BASE, GPIO_PIN_6 | GPIO_PIN_7);
20    ROM_GPIOPinTypeQEI(GPIO_PORTC_BASE, GPIO_PIN_5 | GPIO_PIN_6);
21    ROM_QEIConfigure(QEI0_BASE, QEI_CONFIG_CAPTURE_A_B | QEI_CONFIG_SWAP,
22                     UINT32_MAX);
23    ROM_QEIConfigure(QEI1_BASE, QEI_CONFIG_CAPTURE_A_B | QEI_CONFIG_NO_SWAP,
24                     UINT32_MAX);
25    ROM_QEIVelocityConfigure(QEI0_BASE, QEI_VELDIV_1, VELOCITY_PERIOD);
26    ROM_QEIVelocityConfigure(QEI1_BASE, QEI_VELDIV_1, VELOCITY_PERIOD);
27    ROM_QEIEnable(QEI0_BASE);
28    ROM_QEIEnable(QEI1_BASE);
29    ROM_QEIVelocityEnable(QEI0_BASE);
30    ROM_QEIVelocityEnable(QEI1_BASE);
31}
32
33int32_t left_pos(void) {
34    return ROM_QEIPositionGet(QEI0_BASE);
35}
36
37int32_t right_pos(void) {
38    return ROM_QEIPositionGet(QEI1_BASE);
39}
40
41uint32_t left_speed(void) {
42    return ROM_QEIVelocityGet(QEI0_BASE);
43}
44uint32_t right_speed(void) {
45    return ROM_QEIVelocityGet(QEI1_BASE);
46}
47
48void reset_enc(void) {
49    ROM_QEIPositionSet(QEI0_BASE, 0);
50    ROM_QEIPositionSet(QEI1_BASE, 0);
51}
52
53void set_left(float speed) {
54    // TODO
55}
56
57void set_right(float speed) {
58    // TODO
59}