git.gag.com Git - fw/altos/blob - src/drivers/ao_watchdog.c

   1 /*
   2  * Copyright © 2013 Keith Packard <keithp@keithp.com>
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License as published by
   6  * the Free Software Foundation; version 2 of the License.
   7  *
   8  * This program is distributed in the hope that it will be useful, but
   9  * WITHOUT ANY WARRANTY; without even the implied warranty of
  10  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  11  * General Public License for more details.
  12  *
  13  * You should have received a copy of the GNU General Public License along
  14  * with this program; if not, write to the Free Software Foundation, Inc.,
  15  * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
  16  */
  17
  18 #include <ao.h>
  19
  20 static int      ao_watchdog_enabled = TRUE;
  21
  22 static void
  23 ao_watchdog(void)
  24 {
  25         for (;;) {
  26                 while (!ao_watchdog_enabled)
  27                         ao_sleep(&ao_watchdog_enabled);
  28                 while (ao_watchdog_enabled) {
  29                         ao_delay(AO_WATCHDOG_INTERVAL);
  30                         ao_gpio_set(AO_WATCHDOG_PORT, AO_WATCHDOG_BIT, AO_WATCHDOG_PIN, 1);
  31                         ao_delay(1);
  32                         ao_gpio_set(AO_WATCHDOG_PORT, AO_WATCHDOG_BIT, AO_WATCHDOG_PIN, 0);
  33                 }
  34         }
  35 }
  36
  37 static void
  38 ao_watchdog_set(void)
  39 {
  40         ao_cmd_hex();
  41         if (ao_cmd_status == ao_cmd_success) {
  42                 ao_watchdog_enabled = ao_cmd_lex_i != 0;
  43                 ao_wakeup(&ao_watchdog_enabled);
  44         }
  45 }
  46
  47
  48 static __code struct ao_cmds ao_watchdog_cmds[] = {
  49         { ao_watchdog_set,      "Q <0 off, 1 on>\0Enable or disable watchdog timer" },
  50         { 0,                    NULL },
  51 };
  52
  53 static struct ao_task watchdog_task;
  54
  55 void
  56 ao_watchdog_init(void)
  57 {
  58         ao_enable_output(AO_WATCHDOG_PORT, AO_WATCHDOG_BIT, AO_WATCHDOG, 0);
  59         ao_cmd_register(&ao_watchdog_cmds[0]);
  60         ao_add_task(&watchdog_task, ao_watchdog, "watchdog");
  61 }
  62