git.gag.com Git - fw/altos/blob - src/drivers/ao_ads124s0x.c

   1 /*
   2  * Copyright © 2019 Bdale Garbee <bdale@gag.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, either version 2 of the License, or
   7  * (at your option) any later version.
   8  *
   9  * This program is distributed in the hope that it will be useful, but
  10  * WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  12  * General Public License for more details.
  13  */
  14
  15 #include <ao.h>
  16 #include <ao_exti.h>
  17 #include "ao_ads124s0x.h"
  18
  19 #define DEBUG_LOW       1
  20 #define DEBUG_HIGH      2
  21
  22 #define DEBUG           0
  23
  24 #if DEBUG
  25 #define PRINTD(l, ...) do { if (DEBUG & (l)) { printf ("\r%5u %s: ", ao_tick_count, __func__); printf(__VA_ARGS__); flush(); } } while(0)
  26 #else
  27 #define PRINTD(l,...)
  28 #endif
  29
  30 struct ao_ads124s0x_sample      ao_ads124s0x_current;
  31 uint8_t         nextchan = 0;
  32 uint8_t         ao_ads124s0x_drdy;
  33
  34 static void
  35 ao_ads124s0x_start(void) {
  36         ao_spi_get_bit(AO_ADS124S0X_SPI_CS_PORT,
  37                        AO_ADS124S0X_SPI_CS_PIN,
  38                        AO_ADS124S0X_SPI_BUS,
  39                        AO_ADS124S0X_SPI_SPEED);
  40 }
  41
  42 static void
  43 ao_ads124s0x_stop(void) {
  44         ao_spi_put_bit(AO_ADS124S0X_SPI_CS_PORT,
  45                        AO_ADS124S0X_SPI_CS_PIN,
  46                        AO_ADS124S0X_SPI_BUS);
  47 }
  48
  49 static uint8_t
  50 ao_ads124s0x_reg_read(uint8_t addr)
  51 {
  52         uint8_t d[2];
  53
  54         d[0] = addr | AO_ADS124S0X_RREG;
  55         d[1] = 0;
  56         ao_ads124s0x_start();
  57         ao_spi_send(d, 2, AO_ADS124S0X_SPI_BUS);
  58         ao_spi_recv(d, 1, AO_ADS124S0X_SPI_BUS);
  59         ao_ads124s0x_stop();
  60
  61         PRINTD(DEBUG_LOW, "read %x = %x\n", addr, d[0]);
  62
  63         return d[0];
  64 }
  65
  66 /*
  67 static void
  68 ao_ads124s0x_reg_write(uint8_t addr, uint8_t value)
  69 {
  70         uint8_t d[3];
  71
  72         PRINTD(DEBUG_LOW, "write %x %x\n", addr, value);
  73         d[0] = addr | AO_ADS124S0X_WREG;
  74         d[1] = 0;
  75         d[2] = value;
  76         ao_ads124s0x_start();
  77         ao_spi_send(d, 3, AO_ADS124S0X_SPI_BUS);
  78         ao_ads124s0x_stop();
  79
  80 }
  81 */
  82
  83 static void
  84 ao_ads124s0x_isr(void)
  85 {
  86         ao_wakeup(&ao_ads124s0x_drdy);
  87 }
  88
  89 static void
  90 ao_ads124s0x_setup(void)
  91 {
  92         uint8_t d[20];
  93
  94         uint8_t devid = ao_ads124s0x_reg_read(AO_ADS124S0X_ID);
  95         if (devid != AO_ADS124S0X_ID_ADS124S06)
  96                 ao_panic(AO_PANIC_SELF_TEST_ADS124S0X);
  97
  98         ao_exti_setup(AO_ADS124S0X_DRDY_PORT, AO_ADS124S0X_DRDY_PIN,
  99                 AO_EXTI_MODE_FALLING|AO_EXTI_PRIORITY_HIGH,
 100                 ao_ads124s0x_isr);
 101
 102         /* run converter at 4ksps so we can scan 4 channels at 1ksps using
 103            full duplex ala datasheet section 9.5.4.3 */
 104
 105         d[0] = AO_ADS124S0X_INPMUX | AO_ADS124S0X_WREG;
 106         d[1] = 8;       /* write 8 registers starting with INPMUX */
 107         d[2] = 0x0c;    /* input mux AIN0 relative to AINCOM */
 108         d[3] = 0x00;    /* default first conversion delay, pga disabled */
 109         d[4] = 0x1e;    /* gchop disabled, internal clock, continuous
 110                            conversion, low-latency filter, 4000 SPS */
 111         d[5] = 0x00;    /* ref monitor disabled, ref buffers bypassed, ref
 112                            set to REFP0/REFN0, internal reference off */
 113         d[6] = 0x00;    /* pga otuput rail, low side power switch, excitation
 114                            current source all off */
 115         d[7] = 0xff;    /* idac1 and idac2 disconnected */
 116         d[8] = 0x00;    /* all vbias disconnected */
 117         d[9] = 0x10;    /* sys monitor off, spi timeout disabled, crc disabled,
 118                            prepending status byte disabled */
 119         ao_ads124s0x_start();
 120         ao_spi_send(d, 10, AO_ADS124S0X_SPI_BUS);
 121         ao_ads124s0x_stop();
 122
 123         /* start conversions */
 124
 125         d[0] = AO_ADS124S0X_START;
 126         ao_ads124s0x_start();
 127         ao_spi_send(d, 1, AO_ADS124S0X_SPI_BUS);
 128         ao_ads124s0x_stop();
 129 }
 130
 131 static void
 132 ao_ads124s0x(void)
 133 {
 134         uint8_t d[3], curchan;
 135
 136         ao_ads124s0x_setup();
 137
 138         ao_exti_enable(AO_ADS124S0X_DRDY_PORT, AO_ADS124S0X_DRDY_PIN);
 139
 140         for (;;) {
 141                 ao_sleep(&ao_ads124s0x_drdy);
 142
 143                 curchan = nextchan;
 144                 nextchan = (nextchan + 1) % AO_ADS124S0X_CHANNELS;
 145
 146                 d[0] = AO_ADS124S0X_INPMUX | AO_ADS124S0X_WREG;
 147                 d[1] = 1;
 148                 d[2] = nextchan << 4 | 0x0c; ;  /* relative to AINCOM */
 149                 ao_ads124s0x_start();
 150                 ao_spi_duplex(d, d, 3, AO_ADS124S0X_SPI_BUS);
 151                 ao_ads124s0x_stop();
 152
 153                 ao_ads124s0x_current.ain[curchan] =
 154                         d[0] << 16 | d[1] << 8 | d[2];
 155
 156                 // FIXME
 157                 //      If nextchan == 0, we have a complete set of inputs
 158                 //      and we need to log them somewhere
 159
 160         }
 161 }
 162
 163 static struct ao_task ao_ads124s0x_task;
 164
 165 static void
 166 ao_ads124s0x_dump(void)
 167 {
 168         ao_add_task(&ao_ads124s0x_task, ao_ads124s0x, "ads124s0x");
 169
 170         printf ("ADS124S0X value %d %d %d %d\n",
 171                 ao_ads124s0x_current.ain[0],
 172                 ao_ads124s0x_current.ain[1],
 173                 ao_ads124s0x_current.ain[2],
 174                 ao_ads124s0x_current.ain[3]);
 175 }
 176
 177 const struct ao_cmds ao_ads124s0x_cmds[] = {
 178         { ao_ads124s0x_dump,    "I\0Display ADS124S0X data" },
 179         { 0, NULL },
 180 };
 181
 182 void
 183 ao_ads124s0x_init(void)
 184 {
 185         ao_cmd_register(ao_ads124s0x_cmds);
 186
 187         ao_spi_init_cs(AO_ADS124S0X_SPI_CS_PORT,
 188                 (1 << AO_ADS124S0X_SPI_CS_PIN));
 189
 190 //      ao_add_task(&ao_ads124s0x_task, ao_ads124s0x, "ads124s0x");
 191 }