git.gag.com Git - fw/openalt/blob - adc/adc.c

   1 #include "FreeRTOS.h"
   2
   3 #include "adc.h"
   4
   5 //
   6 //
   7 //
   8 int adcRead0_3 (void)
   9 {
  10 //  AD0_CR = AD_CR_CLKS10 | AD_CR_PDN | ((11 - 1) << AD_CR_CLKDIVSHIFT) | AD_CR_SEL3;
  11 //  AD0_CR |= AD_CR_START_NOW;
  12
  13 //  while (!(AD0_DR3 & AD_DR_DONE))
  14 //    ;
  15
  16 //  return ((AD0_DR3 & AD_DR_RESULTMASK) >> AD_DR_RESULTSHIFT);
  17     return (0);
  18 }
  19
  20 //
  21 //  Assumes PCLK == 48Mhz
  22 //
  23 void adcInit (void)
  24 {
  25 //  SCB_PCONP |= SCB_PCONP_PCAD0;
  26   SCB_PCONP |= SCB_PCONP_PCAD1;
  27
  28 //  PCB_PINSEL1 |= PCB_PINSEL1_P030_AD03;
  29
  30   PCB_PINSEL0 |= PCB_PINSEL0_P012_AD13;
  31   PCB_PINSEL0 |= PCB_PINSEL0_P013_AD14;
  32   PCB_PINSEL1 |= PCB_PINSEL1_P021_AD16;
  33
  34 }
  35
  36 void adcStartXYZ (void)
  37 {
  38   unsigned portLONG ulCompareMatch;
  39
  40   // configure MAT0.1 ... assumes TIMER0 already initialized and running
  41
  42   // Calculate the match value required for 1khz ADC trigger rate
  43   ulCompareMatch = configCPU_CLOCK_HZ / 1000;
  44
  45   // Account for prescaler, protecting against divide by zero.
  46   #if portPRESCALE_VALUE != 0
  47   {
  48         ulCompareMatch /= ( portPRESCALE_VALUE + 1 );
  49   }
  50   #endif
  51   T0_MR1 = ulCompareMatch;
  52
  53   // burst sample 3 channels of accelerometer triggering on MAT0.1
  54   AD1_CR = AD_CR_CLKS10 | AD_CR_PDN | ((11 - 1) << AD_CR_CLKDIVSHIFT) | AD_CR_SEL3 | AD_CR_SEL4 | AD_CR_SEL6 | AD_CR_BURST;
  55   AD1_CR |= AD_CR_START_MAT01;
  56
  57 // following works for one channel repeated sampling
  58 //  AD1_CR = AD_CR_CLKS10 | AD_CR_PDN | ((11 - 1) << AD_CR_CLKDIVSHIFT) | AD_CR_SEL6 | AD_CR_BURST;
  59 //  AD1_CR |= AD_CR_START_NOW;
  60
  61 // wait for conversion to complete
  62 //  while (!(AD1_DR3 & AD_DR_DONE))
  63 //    ;
  64
  65 }
  66
  67 //
  68 //  Read and return X accelerometer value
  69 //
  70 int adcReadX (void)
  71 {
  72   while (!(AD1_DR3 & AD_DR_DONE)) ;
  73   return ((AD1_DR3 & AD_DR_RESULTMASK) >> AD_DR_RESULTSHIFT);
  74 }
  75
  76 //
  77 //  Read and return Y accelerometer value
  78 //
  79 int adcReadY (void)
  80 {
  81   while (!(AD1_DR4 & AD_DR_DONE)) ;
  82   return ((AD1_DR4 & AD_DR_RESULTMASK) >> AD_DR_RESULTSHIFT);
  83 }
  84
  85 //
  86 //  Read and return Z accelerometer value
  87 //
  88 int adcReadZ (void)
  89 {
  90   while (!(AD1_DR6 & AD_DR_DONE)) ;
  91   return ((AD1_DR6 & AD_DR_RESULTMASK) >> AD_DR_RESULTSHIFT);
  92 }