33#include "modules/actuators/actuators_pwm_arch.h"
39#define PWM_FREQUENCY 1000000
49#define TIM1_SERVO_HZ SERVO_HZ
52#define TIM2_SERVO_HZ SERVO_HZ
55#define TIM3_SERVO_HZ SERVO_HZ
58#define TIM4_SERVO_HZ SERVO_HZ
61#define TIM5_SERVO_HZ SERVO_HZ
64#define TIM8_SERVO_HZ SERVO_HZ
67#define TIM9_SERVO_HZ SERVO_HZ
70#define TIM12_SERVO_HZ SERVO_HZ
89#define PWM_CMD_TO_US(_t) (PWM_FREQUENCY * _t / 1000000)
101 __attribute__((unused))
static void pwmpcb(PWMDriver *pwmp __attribute__((unused))) {}
104static PWMConfig pwmcfg1 = {
109 { PWM_OUTPUT_DISABLED, NULL },
110 { PWM_OUTPUT_DISABLED, NULL },
111 { PWM_OUTPUT_DISABLED, NULL },
112 { PWM_OUTPUT_DISABLED, NULL },
120static PWMConfig pwmcfg2 = {
125 { PWM_OUTPUT_DISABLED, NULL },
126 { PWM_OUTPUT_DISABLED, NULL },
127 { PWM_OUTPUT_DISABLED, NULL },
128 { PWM_OUTPUT_DISABLED, NULL },
136static PWMConfig pwmcfg3 = {
141 { PWM_OUTPUT_DISABLED, NULL },
142 { PWM_OUTPUT_DISABLED, NULL },
143 { PWM_OUTPUT_DISABLED, NULL },
144 { PWM_OUTPUT_DISABLED, NULL },
152static PWMConfig pwmcfg4 = {
157 { PWM_OUTPUT_DISABLED, NULL },
158 { PWM_OUTPUT_DISABLED, NULL },
159 { PWM_OUTPUT_DISABLED, NULL },
160 { PWM_OUTPUT_DISABLED, NULL },
168static PWMConfig pwmcfg5 = {
173 { PWM_OUTPUT_DISABLED, NULL },
174 { PWM_OUTPUT_DISABLED, NULL },
175 { PWM_OUTPUT_DISABLED, NULL },
176 { PWM_OUTPUT_DISABLED, NULL },
184static PWMConfig pwmcfg8 = {
189 { PWM_OUTPUT_DISABLED, NULL },
190 { PWM_OUTPUT_DISABLED, NULL },
191 { PWM_OUTPUT_DISABLED, NULL },
192 { PWM_OUTPUT_DISABLED, NULL },
200static PWMConfig pwmcfg9 = {
205 { PWM_OUTPUT_DISABLED, NULL },
206 { PWM_OUTPUT_DISABLED, NULL },
207 { PWM_OUTPUT_DISABLED, NULL },
208 { PWM_OUTPUT_DISABLED, NULL },
216static PWMConfig pwmcfg10 = {
221 { PWM_OUTPUT_DISABLED, NULL },
222 { PWM_OUTPUT_DISABLED, NULL },
223 { PWM_OUTPUT_DISABLED, NULL },
224 { PWM_OUTPUT_DISABLED, NULL },
232static PWMConfig pwmcfg11 = {
237 { PWM_OUTPUT_DISABLED, NULL },
238 { PWM_OUTPUT_DISABLED, NULL },
239 { PWM_OUTPUT_DISABLED, NULL },
240 { PWM_OUTPUT_DISABLED, NULL },
248static PWMConfig pwmcfg12 = {
253 { PWM_OUTPUT_DISABLED, NULL },
254 { PWM_OUTPUT_DISABLED, NULL },
255 { PWM_OUTPUT_DISABLED, NULL },
256 { PWM_OUTPUT_DISABLED, NULL },
272 PWM_SERVO_0_CONF.channels[PWM_SERVO_0_CHANNEL].mode = PWM_OUTPUT_ACTIVE_HIGH;
276 PWM_SERVO_1_CONF.channels[PWM_SERVO_1_CHANNEL].mode = PWM_OUTPUT_ACTIVE_HIGH;
280 PWM_SERVO_2_CONF.channels[PWM_SERVO_2_CHANNEL].mode = PWM_OUTPUT_ACTIVE_HIGH;
284 PWM_SERVO_3_CONF.channels[PWM_SERVO_3_CHANNEL].mode = PWM_OUTPUT_ACTIVE_HIGH;
288 PWM_SERVO_4_CONF.channels[PWM_SERVO_4_CHANNEL].mode = PWM_OUTPUT_ACTIVE_HIGH;
292 PWM_SERVO_5_CONF.channels[PWM_SERVO_5_CHANNEL].mode = PWM_OUTPUT_ACTIVE_HIGH;
296 PWM_SERVO_6_CONF.channels[PWM_SERVO_6_CHANNEL].mode = PWM_OUTPUT_ACTIVE_HIGH;
300 PWM_SERVO_7_CONF.channels[PWM_SERVO_7_CHANNEL].mode = PWM_OUTPUT_ACTIVE_HIGH;
304 PWM_SERVO_8_CONF.channels[PWM_SERVO_8_CHANNEL].mode = PWM_OUTPUT_ACTIVE_HIGH;
308 PWM_SERVO_9_CONF.channels[PWM_SERVO_9_CHANNEL].mode = PWM_OUTPUT_ACTIVE_HIGH;
312 PWM_SERVO_10_CONF.channels[PWM_SERVO_10_CHANNEL].mode = PWM_OUTPUT_ACTIVE_HIGH;
316 PWM_SERVO_11_CONF.channels[PWM_SERVO_11_CHANNEL].mode = PWM_OUTPUT_ACTIVE_HIGH;
320 PWM_SERVO_12_CONF.channels[PWM_SERVO_12_CHANNEL].mode = PWM_OUTPUT_ACTIVE_HIGH;
324 PWM_SERVO_13_CONF.channels[PWM_SERVO_13_CHANNEL].mode = PWM_OUTPUT_ACTIVE_HIGH;
328 PWM_SERVO_14_CONF.channels[PWM_SERVO_14_CHANNEL].mode = PWM_OUTPUT_ACTIVE_HIGH;
332 PWM_SERVO_15_CONF.channels[PWM_SERVO_15_CHANNEL].mode = PWM_OUTPUT_ACTIVE_HIGH;
336 PWM_SERVO_16_CONF.channels[PWM_SERVO_16_CHANNEL].mode = PWM_OUTPUT_ACTIVE_HIGH;
343 pwmStart(&PWMD1, &pwmcfg1);
346 pwmStart(&PWMD2, &pwmcfg2);
349 pwmStart(&PWMD3, &pwmcfg3);
352 pwmStart(&PWMD4, &pwmcfg4);
355 pwmStart(&PWMD5, &pwmcfg5);
358 pwmStart(&PWMD8, &pwmcfg8);
361 pwmStart(&PWMD9, &pwmcfg9);
364 pwmStart(&PWMD10, &pwmcfg10);
367 pwmStart(&PWMD11, &pwmcfg11);
370 pwmStart(&PWMD12, &pwmcfg12);
int32_t actuators_pwm_values[ACTUATORS_PWM_NB]
void gpio_setup_pin_af(ioportid_t port, uint16_t pin, uint8_t af, bool is_output)
Setup a gpio for input or output with alternate function.
#define PWM_CMD_TO_US(_t)
Print the configuration variables from the header.
static void pwmpcb(PWMDriver *pwmp)
PWM callback function.
void actuators_pwm_arch_commit(void)
Arch dependent commit function.
void actuators_pwm_arch_init(void)
Arch dependent init function.
Some architecture independent helper functions for GPIOs.
PRINT_CONFIG_VAR(ONELOOP_ANDI_FILT_CUTOFF)