git.gag.com Git - fw/altos/blob - src/lpc/ao_adc_lpc.c

   1 /*
   2  * Copyright © 2012 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 #include <ao_data.h>
  20
  21 #ifndef AO_ADC_0
  22 #define AO_ADC_0        0
  23 #endif
  24
  25 #ifndef AO_ADC_1
  26 #define AO_ADC_1        0
  27 #endif
  28
  29 #ifndef AO_ADC_2
  30 #define AO_ADC_2        0
  31 #endif
  32
  33 #ifndef AO_ADC_3
  34 #define AO_ADC_3        0
  35 #endif
  36
  37 #ifndef AO_ADC_4
  38 #define AO_ADC_4        0
  39 #endif
  40
  41 #ifndef AO_ADC_5
  42 #define AO_ADC_5        0
  43 #endif
  44
  45 #ifndef AO_ADC_6
  46 #define AO_ADC_6        0
  47 #endif
  48
  49 #ifndef AO_ADC_7
  50 #define AO_ADC_7        0
  51 #endif
  52
  53 #if AO_ADC_7
  54 # define AO_ADC_LAST            7
  55 #else
  56 # if AO_ADC_6
  57 #  define AO_ADC_LAST           6
  58 # else
  59 #  if AO_ADC_5
  60 #   define AO_ADC_LAST          5
  61 #  else
  62 #   if AO_ADC_4
  63 #    define AO_ADC_LAST         4
  64 #   else
  65 #    if AO_ADC_3
  66 #     define AO_ADC_LAST        3
  67 #    else
  68 #     if AO_ADC_2
  69 #      define AO_ADC_LAST       2
  70 #     else
  71 #      if AO_ADC_1
  72 #       define AO_ADC_LAST      1
  73 #      else
  74 #       if AO_ADC_0
  75 #        define AO_ADC_LAST     0
  76 #       endif
  77 #      endif
  78 #     endif
  79 #    endif
  80 #   endif
  81 #  endif
  82 # endif
  83 #endif
  84
  85 #define AO_ADC_MASK     ((AO_ADC_0 << 0) |      \
  86                          (AO_ADC_1 << 1) |      \
  87                          (AO_ADC_2 << 2) |      \
  88                          (AO_ADC_3 << 3) |      \
  89                          (AO_ADC_4 << 4) |      \
  90                          (AO_ADC_5 << 5) |      \
  91                          (AO_ADC_6 << 6) |      \
  92                          (AO_ADC_7 << 7))
  93
  94 #define AO_ADC_CLKDIV   (AO_LPC_SYSCLK / 4500000)
  95
  96 static uint8_t          ao_adc_ready;
  97
  98 static uint16_t         ao_adc_prev[AO_NUM_ADC];
  99
 100 #define sample(id)      do {                            \
 101                 uint16_t        p = *prev;              \
 102                 uint16_t        v = lpc_adc.dr[id];     \
 103                 p -= p >> 4;                            \
 104                 p += v >> 4;                            \
 105                 *prev++ = p;                            \
 106                 *out++ = p >> 1;                        \
 107         } while (0)
 108
 109 void  lpc_adc_isr(void)
 110 {
 111         uint32_t        stat = lpc_adc.stat;
 112         uint16_t        *out;
 113         uint16_t        *prev;
 114
 115         /* Turn off burst mode */
 116         lpc_adc.cr = 0;
 117         lpc_adc.stat = 0;
 118
 119         /* Store converted values in packet */
 120
 121         out = (uint16_t *) &ao_data_ring[ao_data_head].adc;
 122         prev = ao_adc_prev;
 123 #if AO_ADC_0
 124         sample(0);
 125 #endif
 126 #if AO_ADC_1
 127         sample(1);
 128 #endif
 129 #if AO_ADC_2
 130         sample(2);
 131 #endif
 132 #if AO_ADC_3
 133         sample(3);
 134 #endif
 135 #if AO_ADC_4
 136         sample(4);
 137 #endif
 138 #if AO_ADC_5
 139         sample(5);
 140 #endif
 141 #if AO_ADC_6
 142         sample(6);
 143 #endif
 144 #if AO_ADC_7
 145         sample(7);
 146 #endif
 147
 148         AO_DATA_PRESENT(AO_DATA_ADC);
 149         if (ao_data_present == AO_DATA_ALL) {
 150 #if HAS_MS5607
 151                 ao_data_ring[ao_data_head].ms5607_raw = ao_ms5607_current;
 152 #endif
 153 #if HAS_MMA655X
 154                 ao_data_ring[ao_data_head].mma655x = ao_mma655x_current;
 155 #endif
 156 #if HAS_HMC5883
 157                 ao_data_ring[ao_data_head].hmc5883 = ao_hmc5883_current;
 158 #endif
 159 #if HAS_MPU6000
 160                 ao_data_ring[ao_data_head].mpu6000 = ao_mpu6000_current;
 161 #endif
 162                 ao_data_ring[ao_data_head].tick = ao_tick_count;
 163                 ao_data_head = ao_data_ring_next(ao_data_head);
 164                 ao_wakeup((void *) &ao_data_head);
 165         }
 166         ao_adc_ready = 1;
 167 }
 168
 169
 170 /*
 171  * Start the ADC sequence using the DMA engine
 172  */
 173 void
 174 ao_adc_poll(void)
 175 {
 176         if (!ao_adc_ready)
 177                 return;
 178         ao_adc_ready = 0;
 179
 180         lpc_adc.cr = ((AO_ADC_MASK << LPC_ADC_CR_SEL) |
 181                       (AO_ADC_CLKDIV << LPC_ADC_CR_CLKDIV) |
 182                       (1 << LPC_ADC_CR_BURST) |
 183                       (LPC_ADC_CR_CLKS_11 << LPC_ADC_CR_CLKS));
 184 }
 185
 186 static void
 187 ao_adc_dump(void) __reentrant
 188 {
 189         struct ao_data  packet;
 190         int16_t *d;
 191         uint8_t i;
 192
 193         ao_data_get(&packet);
 194 #ifdef AO_ADC_DUMP
 195         AO_ADC_DUMP(&packet);
 196 #else
 197         printf("tick: %5u",  packet.tick);
 198         d = (int16_t *) (&packet.adc);
 199         for (i = 0; i < AO_NUM_ADC; i++)
 200                 printf (" %2d: %5d", i, d[i]);
 201         printf("\n");
 202 #endif
 203 }
 204
 205 __code struct ao_cmds ao_adc_cmds[] = {
 206         { ao_adc_dump,  "a\0Display current ADC values" },
 207         { 0, NULL },
 208 };
 209
 210 void
 211 ao_adc_init(void)
 212 {
 213         lpc_scb.sysahbclkctrl |= (1 << LPC_SCB_SYSAHBCLKCTRL_ADC);
 214         lpc_scb.pdruncfg &= ~(1 << LPC_SCB_PDRUNCFG_ADC_PD);
 215
 216         /* Enable interrupt when last channel is complete */
 217         lpc_adc.inten = (1 << AO_ADC_LAST);
 218
 219         lpc_nvic_set_enable(LPC_ISR_ADC_POS);
 220         lpc_nvic_set_priority(LPC_ISR_ADC_POS, AO_LPC_NVIC_CLOCK_PRIORITY);
 221 #if AO_ADC_0
 222         ao_enable_analog(0, 11, 0);
 223 #endif
 224 #if AO_ADC_1
 225         ao_enable_analog(0, 12, 1);
 226 #endif
 227 #if AO_ADC_2
 228         ao_enable_analog(0, 13, 2);
 229 #endif
 230 #if AO_ADC_3
 231         ao_enable_analog(0, 14, 3);
 232 #endif
 233 #if AO_ADC_4
 234         ao_enable_analog(0, 15, 4);
 235 #endif
 236 #if AO_ADC_5
 237         ao_enable_analog(0, 16, 5);
 238 #endif
 239 #if AO_ADC_6
 240         ao_enable_analog(0, 22, 6);
 241 #endif
 242 #if AO_ADC_7
 243         ao_enable_analog(0, 23, 7);
 244 #endif
 245
 246         lpc_adc.cr = ((AO_ADC_MASK << LPC_ADC_CR_SEL) |
 247                       (AO_ADC_CLKDIV << LPC_ADC_CR_CLKDIV) |
 248                       (0 << LPC_ADC_CR_BURST) |
 249                       (LPC_ADC_CR_CLKS_11 << LPC_ADC_CR_CLKS));
 250
 251         ao_cmd_register(&ao_adc_cmds[0]);
 252
 253         ao_adc_ready = 1;
 254 }