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 - 1)
  95
  96 static uint8_t                  ao_adc_ready;
  97
  98 void  lpc_adc_isr(void)
  99 {
 100         uint32_t        stat = lpc_adc.stat;
 101         uint16_t        *out;
 102
 103         lpc_adc.cr = ((AO_ADC_MASK << LPC_ADC_CR_SEL) |
 104                       (AO_ADC_CLKDIV << LPC_ADC_CR_CLKDIV) |
 105                       (0 << LPC_ADC_CR_BURST) |
 106                       (LPC_ADC_CR_CLKS_11 << LPC_ADC_CR_CLKS));
 107         lpc_adc.stat = 0;
 108
 109         /* Store converted values in packet */
 110
 111         out = (uint16_t *) &ao_data_ring[ao_data_head].adc;
 112 #if AO_ADC_0
 113         *out++ = lpc_adc.dr[0] >> 1;
 114 #endif
 115 #if AO_ADC_1
 116         *out++ = lpc_adc.dr[1] >> 1;
 117 #endif
 118 #if AO_ADC_2
 119         *out++ = lpc_adc.dr[2] >> 1;
 120 #endif
 121 #if AO_ADC_3
 122         *out++ = lpc_adc.dr[3] >> 1;
 123 #endif
 124 #if AO_ADC_4
 125         *out++ = lpc_adc.dr[4] >> 1;
 126 #endif
 127 #if AO_ADC_5
 128         *out++ = lpc_adc.dr[5] >> 1;
 129 #endif
 130 #if AO_ADC_6
 131         *out++ = lpc_adc.dr[6] >> 1;
 132 #endif
 133 #if AO_ADC_7
 134         *out++ = lpc_adc.dr[7] >> 1;
 135 #endif
 136
 137         AO_DATA_PRESENT(AO_DATA_ADC);
 138         if (ao_data_present == AO_DATA_ALL) {
 139 #if HAS_MS5607
 140                 ao_data_ring[ao_data_head].ms5607_raw = ao_ms5607_current;
 141 #endif
 142 #if HAS_MMA655X
 143                 ao_data_ring[ao_data_head].mma655x = ao_mma655x_current;
 144 #endif
 145 #if HAS_HMC5883
 146                 ao_data_ring[ao_data_head].hmc5883 = ao_hmc5883_current;
 147 #endif
 148 #if HAS_MPU6000
 149                 ao_data_ring[ao_data_head].mpu6000 = ao_mpu6000_current;
 150 #endif
 151                 ao_data_ring[ao_data_head].tick = ao_tick_count;
 152                 ao_data_head = ao_data_ring_next(ao_data_head);
 153                 ao_wakeup((void *) &ao_data_head);
 154         }
 155         ao_adc_ready = 1;
 156 }
 157
 158
 159 /*
 160  * Start the ADC sequence using the DMA engine
 161  */
 162 void
 163 ao_adc_poll(void)
 164 {
 165         if (!ao_adc_ready)
 166                 return;
 167         ao_adc_ready = 0;
 168
 169         lpc_adc.cr = ((AO_ADC_MASK << LPC_ADC_CR_SEL) |
 170                       (AO_ADC_CLKDIV << LPC_ADC_CR_CLKDIV) |
 171                       (1 << LPC_ADC_CR_BURST) |
 172                       (LPC_ADC_CR_CLKS_11 << LPC_ADC_CR_CLKS));
 173 }
 174
 175 static void
 176 ao_adc_dump(void) __reentrant
 177 {
 178         struct ao_data  packet;
 179         int16_t *d;
 180         uint8_t i;
 181
 182         ao_data_get(&packet);
 183 #ifdef AO_ADC_DUMP
 184         AO_ADC_DUMP(&packet);
 185 #else
 186         printf("tick: %5u",  packet.tick);
 187         d = (int16_t *) (&packet.adc);
 188         for (i = 0; i < AO_NUM_ADC; i++)
 189                 printf (" %2d: %5d", i, d[i]);
 190         printf("\n");
 191 #endif
 192 }
 193
 194 __code struct ao_cmds ao_adc_cmds[] = {
 195         { ao_adc_dump,  "a\0Display current ADC values" },
 196         { 0, NULL },
 197 };
 198
 199 void
 200 ao_adc_init(void)
 201 {
 202         lpc_scb.sysahbclkctrl |= (1 << LPC_SCB_SYSAHBCLKCTRL_ADC);
 203         lpc_scb.pdruncfg &= ~(1 << LPC_SCB_PDRUNCFG_ADC_PD);
 204
 205         /* Enable interrupt when last channel is complete */
 206         lpc_adc.inten = (1 << AO_ADC_LAST);
 207
 208         lpc_nvic_set_enable(LPC_ISR_ADC_POS);
 209         lpc_nvic_set_priority(LPC_ISR_ADC_POS, AO_LPC_NVIC_CLOCK_PRIORITY);
 210 #if AO_ADC_0
 211         ao_enable_analog(0, 11, 0);
 212 #endif
 213 #if AO_ADC_1
 214         ao_enable_analog(0, 12, 1);
 215 #endif
 216 #if AO_ADC_2
 217         ao_enable_analog(0, 13, 2);
 218 #endif
 219 #if AO_ADC_3
 220         ao_enable_analog(0, 14, 3);
 221 #endif
 222 #if AO_ADC_4
 223         ao_enable_analog(0, 15, 4);
 224 #endif
 225 #if AO_ADC_5
 226         ao_enable_analog(0, 16, 5);
 227 #endif
 228 #if AO_ADC_6
 229         ao_enable_analog(0, 22, 6);
 230 #endif
 231 #if AO_ADC_7
 232         ao_enable_analog(0, 23, 7);
 233 #endif
 234
 235         lpc_adc.cr = ((AO_ADC_MASK << LPC_ADC_CR_SEL) |
 236                       (AO_ADC_CLKDIV << LPC_ADC_CR_CLKDIV) |
 237                       (0 << LPC_ADC_CR_BURST) |
 238                       (LPC_ADC_CR_CLKS_11 << LPC_ADC_CR_CLKS));
 239
 240         ao_cmd_register(&ao_adc_cmds[0]);
 241
 242         ao_adc_ready = 1;
 243 }