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 #ifdef TELESCIENCE
  24 const uint8_t   adc_channels[AO_LOG_TELESCIENCE_NUM_ADC] = {
  25         0x00,
  26         0x01,
  27         0x04,
  28         0x05,
  29         0x06,
  30         0x07,
  31         0x20,
  32         0x21,
  33         0x22,
  34         0x23,
  35         0x24,
  36         0x25,
  37 };
  38 #endif
  39
  40 #ifdef TELEPYRO
  41 const uint8_t   adc_channels[AO_TELEPYRO_NUM_ADC] = {
  42         0x00,   /* ADC0  v_batt */
  43         0x04,   /* ADC4  sense_a */
  44         0x05,   /* ADC5  sense_b */
  45         0x06,   /* ADC6  sense_c */
  46         0x07,   /* ADC7  sense_d */
  47         0x23,   /* ADC11 sense_e */
  48         0x22,   /* ADC10 sense_f */
  49         0x21,   /* ADC9 sense_g */
  50         0x20,   /* ADC8 sense_h */
  51 };
  52 #endif
  53
  54 #define NUM_ADC (sizeof (adc_channels) / sizeof (adc_channels[0]))
  55
  56 static uint8_t  ao_adc_channel;
  57
  58 #define ADC_CHANNEL_LOW(c)      (((c) & 0x1f) << MUX0)
  59 #define ADC_CHANNEL_HIGH(c)     ((((c) & 0x20) >> 5) << MUX5)
  60
  61 #define ADCSRA_INIT     ((1 << ADEN) |          /* Enable ADC */                \
  62                          (0 << ADATE) |         /* No auto ADC trigger */       \
  63                          (1 << ADIF) |          /* Clear interrupt */           \
  64                          (0 << ADIE) |          /* Enable interrupt */          \
  65                          (6 << ADPS0))          /* Prescale clock by 64 */
  66
  67 #define ADCSRB_INIT     ((0 << ADHSM) |         /* No high-speed mode */ \
  68                          (0 << ACME) |          /* Some comparitor thing */ \
  69                          (0 << ADTS0))          /* Free running mode (don't care) */
  70
  71 static void
  72 ao_adc_start(void)
  73 {
  74         uint8_t channel = adc_channels[ao_adc_channel];
  75         ADMUX = ((0 << REFS1) |                         /* AVcc reference */
  76                  (1 << REFS0) |                         /* AVcc reference */
  77                  (1 << ADLAR) |                         /* Left-shift results */
  78                  (ADC_CHANNEL_LOW(channel)));           /* Select channel */
  79
  80         ADCSRB = (ADCSRB_INIT |
  81                   ADC_CHANNEL_HIGH(channel));           /* High channel bit */
  82
  83         ADCSRA = (ADCSRA_INIT |
  84                   (1 << ADSC) |
  85                   (1 << ADIE));                         /* Start conversion */
  86 }
  87
  88 ISR(ADC_vect)
  89 {
  90         uint16_t        value;
  91
  92         /* Must read ADCL first or the value there will be lost */
  93         value = ADCL;
  94         value |= (ADCH << 8);
  95         ao_adc_ring[ao_adc_head].adc[ao_adc_channel] = value;
  96         if (++ao_adc_channel < NUM_ADC)
  97                 ao_adc_start();
  98         else {
  99                 ADCSRA = ADCSRA_INIT;
 100                 ao_adc_ring[ao_adc_head].tick = ao_time();
 101                 ao_adc_head = ao_adc_ring_next(ao_adc_head);
 102                 ao_wakeup((void *) &ao_adc_head);
 103                 ao_cpu_sleep_disable = 0;
 104         }
 105 }
 106
 107 void
 108 ao_adc_poll(void)
 109 {
 110         ao_cpu_sleep_disable = 1;
 111         ao_adc_channel = 0;
 112         ao_adc_start();
 113 }
 114
 115 void
 116 ao_adc_get(__xdata struct ao_adc *packet)
 117 {
 118         uint8_t i = ao_adc_ring_prev(ao_adc_head);
 119         memcpy(packet, (void *) &ao_adc_ring[i], sizeof (struct ao_adc));
 120 }
 121
 122 static void
 123 ao_adc_dump(void) __reentrant
 124 {
 125         static __xdata struct ao_adc    packet;
 126         uint8_t i;
 127         ao_adc_get(&packet);
 128 #ifdef TELEPYRO
 129         printf("ADMUX:  %02x\n", ADMUX);
 130         printf("ADCSRA: %02x\n", ADCSRA);
 131         printf("ADCSRB: %02x\n", ADCSRB);
 132         printf("DIDR0:  %02x\n", DIDR0);
 133         printf("DIDR2:  %02x\n", DIDR2);
 134         printf("PORTF:  %02x\n", PORTF);
 135         printf("DDRF:   %02x\n", DDRF);
 136         printf("PINF:   %02x\n", PINF);
 137 #endif
 138         printf("tick: %5u",  packet.tick);
 139         for (i = 0; i < NUM_ADC; i++)
 140                 printf (" %2d: %5u", i, packet.adc[i]);
 141
 142
 143 #ifdef TELEPYRO
 144         ADMUX = 0x60;
 145         ADCSRB = 0x00;
 146         ADCSRA = 0xc6;
 147         while (ADCSRA & 0x40)
 148                 ;
 149         printf ("ADCL:  %02x\n", ADCL);
 150         printf ("ADCH:  %02x\n", ADCH);
 151         printf ("\n");
 152 #endif
 153 }
 154
 155 __code struct ao_cmds ao_adc_cmds[] = {
 156         { ao_adc_dump,  "a\0Display current ADC values" },
 157         { 0, NULL },
 158 };
 159
 160 void
 161 ao_adc_init(void)
 162 {
 163         DIDR0 = 0xf3;
 164         DIDR2 = 0x3f;
 165         ADCSRB = ADCSRB_INIT;
 166         ADCSRA = ADCSRA_INIT;
 167         ao_cmd_register(&ao_adc_cmds[0]);
 168 }