diff options
Diffstat (limited to 'src/gpiocmds.c')
-rw-r--r-- | src/gpiocmds.c | 72 |
1 files changed, 2 insertions, 70 deletions
diff --git a/src/gpiocmds.c b/src/gpiocmds.c index 283d3d2e..70608a6f 100644 --- a/src/gpiocmds.c +++ b/src/gpiocmds.c @@ -4,12 +4,11 @@ // // This file may be distributed under the terms of the GNU GPLv3 license. -#include <stddef.h> // offsetof #include "basecmd.h" // alloc_oid -#include "board/gpio.h" // struct gpio +#include "board/gpio.h" // struct gpio_out #include "board/irq.h" // irq_save #include "command.h" // DECL_COMMAND -#include "sched.h" // DECL_TASK +#include "sched.h" // sched_timer /**************************************************************** @@ -87,73 +86,6 @@ DECL_COMMAND(command_set_digital_out, "set_digital_out pin=%u value=%c"); /**************************************************************** - * Hardware PWM pins - ****************************************************************/ - -struct pwm_out_s { - struct timer timer; - struct gpio_pwm pin; - uint32_t max_duration; - uint8_t value, default_value; -}; - -static uint8_t -pwm_event(struct timer *timer) -{ - struct pwm_out_s *p = container_of(timer, struct pwm_out_s, timer); - gpio_pwm_write(p->pin, p->value); - if (p->value == p->default_value || !p->max_duration) - return SF_DONE; - p->timer.waketime += p->max_duration; - p->timer.func = digital_end_event; - return SF_RESCHEDULE; -} - -void -command_config_pwm_out(uint32_t *args) -{ - struct pwm_out_s *p = alloc_oid(args[0], command_config_pwm_out, sizeof(*p)); - p->default_value = args[3]; - p->pin = gpio_pwm_setup(args[1], args[2], p->default_value); - p->max_duration = args[4]; -} -DECL_COMMAND(command_config_pwm_out, - "config_pwm_out oid=%c pin=%u cycle_ticks=%u default_value=%c" - " max_duration=%u"); - -void -command_schedule_pwm_out(uint32_t *args) -{ - struct pwm_out_s *p = lookup_oid(args[0], command_config_pwm_out); - sched_del_timer(&p->timer); - p->timer.func = pwm_event; - p->timer.waketime = args[1]; - p->value = args[2]; - sched_timer(&p->timer); -} -DECL_COMMAND(command_schedule_pwm_out, - "schedule_pwm_out oid=%c clock=%u value=%c"); - -static void -pwm_shutdown(void) -{ - uint8_t i; - struct pwm_out_s *p; - foreach_oid(i, p, command_config_pwm_out) { - gpio_pwm_write(p->pin, p->default_value); - } -} -DECL_SHUTDOWN(pwm_shutdown); - -void -command_set_pwm_out(uint32_t *args) -{ - gpio_pwm_setup(args[0], args[1], args[2]); -} -DECL_COMMAND(command_set_pwm_out, "set_pwm_out pin=%u cycle_ticks=%u value=%c"); - - -/**************************************************************** * Soft PWM output pins ****************************************************************/ |