projects/step-up/control.c

   1 #include <inttypes.h>
   2 #include <stdlib.h> // for NULL
   3
   4 #include "lights.h"
   5
   6 static pattern_t on_pattern [] = {
   7         { 1, 0x10 },
   8         PATTERN_END
   9 };
  10
  11 static pattern_t blink_pattern[] = {
  12         { 1, 0x1 },
  13         { 0, 0x2 },
  14         { 1, 0x1 },
  15         { 0, 0x8 },
  16         { 1, 0x1 },
  17         { 0, 0x8 },
  18         PATTERN_END
  19 };
  20
  21 static pattern_t slow_pattern[] = {
  22         { 1, 0x1 },
  23         { 0, 0x1F },
  24         PATTERN_END
  25 };
  26
  27 static unsigned char light_mode;
  28 static union {
  29         unsigned char errors;
  30         struct {
  31                 unsigned char shutdown_in_progress : 1;
  32                 unsigned char pwmled_error : 1;
  33                 unsigned char battery_low : 1;
  34         };
  35 } e;
  36
  37 void set_error(unsigned char err)
  38 {
  39         switch(err) {
  40         case ERR_BATTERY:
  41                 e.battery_low = 1;
  42                 pwmled_set_target(0);
  43                 pattern_reload();
  44                 break;
  45         case ERR_PWMLED:
  46                 e.pwmled_error = 1;
  47                 break;
  48         }
  49 }
  50
  51 void init_control()
  52 {
  53         light_mode = 1;
  54         e.errors = 0;
  55         short_press();
  56 }
  57
  58 void long_press_start()
  59 {
  60         e.shutdown_in_progress = 1;
  61         pattern_reload();
  62 }
  63
  64 void short_press()
  65 {
  66         if (e.battery_low)
  67                 return;
  68
  69         if (++light_mode >= 2*N_PWMLED_MODES)
  70                 light_mode = 0;
  71
  72         pwmled_set_target(light_mode < N_PWMLED_MODES
  73                 ? light_mode
  74                 : light_mode - N_PWMLED_MODES);
  75         pattern_reload();
  76 }
  77
  78 void long_press()
  79 {
  80         e.shutdown_in_progress = 0;
  81         pattern_reload();
  82 }
  83
  84 pattern_t *pwmled_pattern_select()
  85 {
  86         if (e.shutdown_in_progress)
  87                 return NULL;
  88
  89         if (e.battery_low)
  90                 return slow_pattern;
  91
  92         if (light_mode == 0) {
  93                 return slow_pattern;
  94         } else if (light_mode < N_PWMLED_MODES) {
  95                 return blink_pattern;
  96         } else {
  97                 return on_pattern;
  98         }
  99 }
 100
 101 pattern_t *status_led_pattern_select()
 102 {
 103         if (e.shutdown_in_progress)
 104                 return on_pattern;
 105
 106         if (e.pwmled_error)
 107                 return number_pattern(3, 1);
 108
 109         if (e.battery_low)
 110                 return number_pattern(1, 1);
 111
 112         return number_pattern(light_mode+1, 0);
 113 }
 114
 115 #if 0
 116 void brake_on()
 117 {
 118         braking = 1;
 119         gpio_set(0, 1);
 120         led_set_pattern(N_PWMLEDS, status_led_pattern_select());
 121         led_set_pattern(0, pwmled0_pattern_select());
 122 }
 123
 124 void brake_off()
 125 {
 126         braking = 0;
 127         gpio_set(0, 0);
 128         led_set_pattern(N_PWMLEDS, status_led_pattern_select());
 129         led_set_pattern(0, pwmled0_pattern_select());
 130 }
 131
 132 #endif