|
5 | 5 |
|
6 | 6 | #if PBDRV_CONFIG_PWM_TIAM1808 |
7 | 7 |
|
8 | | -#include <stdio.h> |
9 | | -#include <string.h> |
10 | | - |
11 | 8 | #include <pbdrv/pwm.h> |
12 | 9 | #include <pbdrv/gpio.h> |
13 | 10 | #include <pbio/error.h> |
14 | 11 |
|
15 | | -#include <tiam1808/hw/hw_syscfg0_AM1808.h> |
16 | | -#include <tiam1808/hw/hw_types.h> |
17 | | -#include <tiam1808/hw/soc_AM1808.h> |
18 | | -#include <tiam1808/pruss.h> |
19 | | -#include <tiam1808/psc.h> |
20 | | -#include <tiam1808/timer.h> |
21 | | - |
22 | 12 | #include "../drv/pwm/pwm.h" |
23 | 13 | #include "../../drv/led/led_pwm.h" |
24 | 14 | #include "../../drv/pwm/pwm_ev3.h" |
25 | 15 | #include "../../drv/gpio/gpio_ev3.h" |
26 | 16 |
|
27 | | -// This needs to match the interface expected by the PRU firmware |
28 | | -typedef struct shared_ram { |
29 | | - uint8_t pwms[PBDRV_PWM_EV3_NUM_CHANNELS]; |
30 | | -} shared_ram; |
31 | | -static volatile shared_ram pru1_shared_ram __attribute__((section(".shared1"))); |
32 | | - |
33 | 17 | static pbio_error_t pbdrv_pwm_tiam1808_set_duty(pbdrv_pwm_dev_t *dev, uint32_t ch, uint32_t value) { |
34 | 18 | // Blue not available. |
35 | 19 | if (ch == PBDRV_LED_PWM_CHANNEL_INVALID) { |
36 | 20 | return PBIO_SUCCESS; |
37 | 21 | } |
38 | 22 |
|
39 | | - pru1_shared_ram.pwms[ch] = value; |
| 23 | + pbdrv_ev3_pru1_shared_ram.pwms[ch] = value; |
40 | 24 | return PBIO_SUCCESS; |
41 | 25 | } |
42 | 26 |
|
43 | 27 | static const pbdrv_pwm_driver_funcs_t pbdrv_pwm_tiam1808_funcs = { |
44 | 28 | .set_duty = pbdrv_pwm_tiam1808_set_duty, |
45 | 29 | }; |
46 | 30 |
|
47 | | -extern char _pru1_start; |
48 | | -extern char _pru1_end; |
49 | | - |
50 | 31 | #define PINMUX_ALT_PRU1 4 |
51 | 32 |
|
52 | 33 | void pbdrv_pwm_tiam1808_init(pbdrv_pwm_dev_t *devs) { |
53 | | - // Enable Timer0 "34" half to count up to 256 * 256 |
54 | | - // This is used by the PRU to time the PWM |
55 | | - TimerPreScalarCount34Set(SOC_TMR_0_REGS, 0); |
56 | | - TimerPeriodSet(SOC_TMR_0_REGS, TMR_TIMER34, 256 * 256 - 1); |
57 | | - TimerEnable(SOC_TMR_0_REGS, TMR_TIMER34, TMR_ENABLE_CONT); |
58 | | - |
59 | | - // Clear shared command memory |
60 | | - memset((void *)&pru1_shared_ram, 0, sizeof(shared_ram)); |
61 | | - |
62 | | - // Enable PRU1 and load its firmware |
63 | | - PSCModuleControl(SOC_PSC_0_REGS, HW_PSC_PRU, PSC_POWERDOMAIN_ALWAYS_ON, PSC_MDCTL_NEXT_ENABLE); |
64 | | - PRUSSDRVPruDisable(1); |
65 | | - PRUSSDRVPruReset(1); |
66 | | - unsigned int *fw_start = (unsigned int *)&_pru1_start; |
67 | | - uint32_t fw_sz = &_pru1_end - &_pru1_start; |
68 | | - PRUSSDRVPruWriteMemory(PRUSS0_PRU1_IRAM, 0, fw_start, fw_sz); |
69 | | - // Set constant table C30 to point to shared memory |
70 | | - PRUSSDRVPruSetCTable(1, 30, (((uint32_t)&pru1_shared_ram) >> 8) & 0xffff); |
71 | | - PRUSSDRVPruEnable(1); |
72 | | - |
73 | 34 | devs[0].funcs = &pbdrv_pwm_tiam1808_funcs; |
74 | 35 |
|
75 | 36 | // Set GPIO alt modes for the PRU |
76 | | - for (int j = 0; j < PBDRV_PWM_EV3_NUM_CHANNELS; j++) { |
| 37 | + for (int j = 0; j < PBDRV_EV3_PRU1_NUM_PWM_CHANNELS; j++) { |
77 | 38 | pbdrv_gpio_alt(&pbdrv_pwm_tiam1808_platform_data.gpios[j], PINMUX_ALT_PRU1); |
78 | 39 | } |
79 | 40 | } |
|
0 commit comments