git.gag.com Git - fw/altos/blob - src/avr/ao_adc_avr.c

   1 /*
   2  * Copyright © 2011 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 volatile __xdata struct ao_adc  ao_adc_ring[AO_ADC_RING];
  21 volatile __data uint8_t         ao_adc_head;
  22
  23 const uint8_t   adc_channels[AO_LOG_TELESCIENCE_NUM_ADC] = {
  24         0x00,
  25         0x01,
  26         0x04,
  27         0x05,
  28         0x06,
  29         0x07,
  30         0x20,
  31         0x21,
  32         0x22,
  33         0x23,
  34         0x24,
  35         0x25,
  36 };
  37
  38 static uint8_t  ao_adc_channel;
  39
  40 #define ADC_CHANNEL_LOW(c)      (((c) & 0x1f) << MUX0)
  41 #define ADC_CHANNEL_HIGH(c)     ((((c) & 0x20) >> 5) << MUX5)
  42
  43 #define ADCSRA_INIT     ((1 << ADEN) |          /* Enable ADC */                \
  44                          (0 << ADATE) |         /* No auto ADC trigger */       \
  45                          (1 << ADIF) |          /* Clear interrupt */           \
  46                          (0 << ADIE) |          /* Enable interrupt */          \
  47                          (6 << ADPS0))          /* Prescale clock by 64 */
  48
  49 #define ADCSRB_INIT     ((0 << ADHSM) |         /* No high-speed mode */ \
  50                          (0 << ACME) |          /* Some comparitor thing */ \
  51                          (2 << ADTS0))          /* Free running mode (don't care) */
  52
  53 static void
  54 ao_adc_start(void)
  55 {
  56         uint8_t channel = adc_channels[ao_adc_channel];
  57         ADMUX = ((0 << REFS1) |                         /* AVcc reference */
  58                  (1 << REFS0) |                         /* AVcc reference */
  59                  (1 << ADLAR) |                         /* Left-shift results */
  60                  (ADC_CHANNEL_LOW(channel)));           /* Select channel */
  61
  62         ADCSRB = (ADCSRB_INIT |
  63                   ADC_CHANNEL_HIGH(channel));           /* High channel bit */
  64
  65         ADCSRA = (ADCSRA_INIT |
  66                   (1 << ADSC) |
  67                   (1 << ADIE));                         /* Start conversion */
  68 }
  69
  70 ISR(ADC_vect)
  71 {
  72         uint16_t        value;
  73
  74         /* Must read ADCL first or the value there will be lost */
  75         value = ADCL;
  76         value |= (ADCH << 8);
  77         ao_adc_ring[ao_adc_head].adc[ao_adc_channel] = value;
  78         if (++ao_adc_channel < AO_TELESCIENCE_NUM_ADC)
  79                 ao_adc_start();
  80         else {
  81                 ADCSRA = ADCSRA_INIT;
  82                 ao_adc_ring[ao_adc_head].tick = ao_time();
  83                 ao_adc_head = ao_adc_ring_next(ao_adc_head);
  84                 ao_wakeup((void *) &ao_adc_head);
  85                 ao_cpu_sleep_disable = 0;
  86         }
  87 }
  88
  89 void
  90 ao_adc_poll(void)
  91 {
  92         ao_cpu_sleep_disable = 1;
  93         ao_adc_channel = 0;
  94         ao_adc_start();
  95 }
  96
  97 void
  98 ao_adc_get(__xdata struct ao_adc *packet)
  99 {
 100         uint8_t i = ao_adc_ring_prev(ao_adc_head);
 101         memcpy(packet, (void *) &ao_adc_ring[i], sizeof (struct ao_adc));
 102 }
 103
 104 static void
 105 ao_adc_dump(void) __reentrant
 106 {
 107         static __xdata struct ao_adc    packet;
 108         uint8_t i;
 109         ao_adc_get(&packet);
 110         printf("tick: %5u",  packet.tick);
 111         for (i = 0; i < AO_TELESCIENCE_NUM_ADC; i++)
 112                 printf (" %2d: %5u", i, packet.adc[i]);
 113         printf ("\n");
 114 }
 115
 116 __code struct ao_cmds ao_adc_cmds[] = {
 117         { ao_adc_dump,  "a\0Display current ADC values" },
 118         { 0, NULL },
 119 };
 120
 121 void
 122 ao_adc_init(void)
 123 {
 124         DIDR0 = 0xf3;
 125         DIDR2 = 0x3f;
 126         ADCSRB = ADCSRB_INIT;
 127         ADCSRA = ADCSRA_INIT;
 128         ao_cmd_register(&ao_adc_cmds[0]);
 129 }