Diff: DeviceSSP.c

Revision:

166:c3c0b8a90d81

Parent:

156:e68ee0bcdcda

Child:

167:bedc0a9d559a

--- a/DeviceSSP.c	Fri May 20 14:03:58 2016 +0000
+++ b/DeviceSSP.c	Sun May 22 18:59:20 2016 +0000
@@ -67,20 +67,32 @@
   LPC_GPIO0->FIOSET = 1<<16; //set SSEL signal for ADCs
   //Get samples
   uint32_t value;
+  
+  device.controller.SSP.in[4] += LPC_SSP0->DR;
+  device.controller.SSP.in[3] += LPC_SSP0->DR;
+  device.controller.SSP.in[2] += LPC_SSP0->DR;
+  device.controller.SSP.in[1] += LPC_SSP0->DR;
+  device.controller.SSP.in[0] += LPC_SSP0->DR;
+  
+  /*
   device.controller.SSP.accumulator[4] += LPC_SSP0->DR;
   device.controller.SSP.accumulator[3] += LPC_SSP0->DR;
   device.controller.SSP.accumulator[2] += LPC_SSP0->DR;
   device.controller.SSP.accumulator[1] += LPC_SSP0->DR;
   device.controller.SSP.accumulator[0] += LPC_SSP0->DR;
+  */
+  
+  //Clear input queue
   while (LPC_SSP0->SR & 0x00000004) value = LPC_SSP0->DR;
+  /*
   //Average samples for dither period
-  if (device.measurement.counter == 0) {
+  if (device.measurement.counter == 31) {
     for (uint8_t i = 0; i < 5; i++){
       device.controller.SSP.in[i] = device.controller.SSP.accumulator[i] >> 5;
-      device.controller.SSP.accumulator[i] = 0;  
-      device.controller.SSP.dataReady = 1;
+      device.controller.SSP.accumulator[i] = 0;
     }
   }
+  */
 }
 
 void DeviceSSPTransmit(uint8_t index){