Diff: DeviceSequencer.c

Revision:

198:78dd6d14d108

Parent:

197:7a05523bf588

--- a/DeviceSequencer.c	Wed Oct 19 10:55:05 2016 +0000
+++ /dev/null	Thu Jan 01 00:00:00 1970 +0000
@@ -1,201 +0,0 @@
-#include "Device.h"
-extern Device device;
-
-void InitSequencerDefaultSettings(void){
-  device.sequencer.sampler.settings.enabled = 1;
-  device.sequencer.sampler.settings.amplitude = 0x1e0000; //30V
-  device.sequencer.sampler.settings.position[0] = 0;      //starting output sample position
-  device.sequencer.sampler.settings.position[1] = 16;     //starting reference (delayed) sample position
-  device.sequencer.sampler.settings.sequence[0] = 0;
-  device.sequencer.sampler.settings.sequence[1] = 6424;
-  device.sequencer.sampler.settings.sequence[2] = 12785;
-  device.sequencer.sampler.settings.sequence[3] = 19024;
-  device.sequencer.sampler.settings.sequence[4] = 25080;
-  device.sequencer.sampler.settings.sequence[5] = 30893;
-  device.sequencer.sampler.settings.sequence[6] = 36410;
-  device.sequencer.sampler.settings.sequence[7] = 41576;
-  device.sequencer.sampler.settings.sequence[8] = 46341;
-  device.sequencer.sampler.settings.sequence[9] = 50660;
-  device.sequencer.sampler.settings.sequence[10] = 54491;
-  device.sequencer.sampler.settings.sequence[11] = 57798;
-  device.sequencer.sampler.settings.sequence[12] = 60547;
-  device.sequencer.sampler.settings.sequence[13] = 62714;
-  device.sequencer.sampler.settings.sequence[14] = 64277;
-  device.sequencer.sampler.settings.sequence[15] = 65220;
-  device.sequencer.sampler.settings.sequence[16] = 65536;
-  device.sequencer.sampler.settings.sequence[17] = 65220;
-  device.sequencer.sampler.settings.sequence[18] = 64277;
-  device.sequencer.sampler.settings.sequence[19] = 62714;
-  device.sequencer.sampler.settings.sequence[20] = 60547;
-  device.sequencer.sampler.settings.sequence[21] = 57798;
-  device.sequencer.sampler.settings.sequence[22] = 54491;
-  device.sequencer.sampler.settings.sequence[23] = 50660;
-  device.sequencer.sampler.settings.sequence[24] = 46341;
-  device.sequencer.sampler.settings.sequence[25] = 41576;
-  device.sequencer.sampler.settings.sequence[26] = 36410;
-  device.sequencer.sampler.settings.sequence[27] = 30893;
-  device.sequencer.sampler.settings.sequence[28] = 25080;
-  device.sequencer.sampler.settings.sequence[29] = 19024;
-  device.sequencer.sampler.settings.sequence[30] = 12785;
-  device.sequencer.sampler.settings.sequence[31] = 6424;
-  device.sequencer.sampler.settings.sequence[32] = 0;
-  device.sequencer.sampler.settings.sequence[33] = -6424;
-  device.sequencer.sampler.settings.sequence[34] = -12785;
-  device.sequencer.sampler.settings.sequence[35] = -19024;
-  device.sequencer.sampler.settings.sequence[36] = -25080;
-  device.sequencer.sampler.settings.sequence[37] = -30893;
-  device.sequencer.sampler.settings.sequence[38] = -36410;
-  device.sequencer.sampler.settings.sequence[39] = -41576;
-  device.sequencer.sampler.settings.sequence[40] = -46341;
-  device.sequencer.sampler.settings.sequence[41] = -50660;
-  device.sequencer.sampler.settings.sequence[42] = -54491;
-  device.sequencer.sampler.settings.sequence[43] = -57798;
-  device.sequencer.sampler.settings.sequence[44] = -60547;
-  device.sequencer.sampler.settings.sequence[45] = -62714;
-  device.sequencer.sampler.settings.sequence[46] = -64277;
-  device.sequencer.sampler.settings.sequence[47] = -65220;
-  device.sequencer.sampler.settings.sequence[48] = -65536;
-  device.sequencer.sampler.settings.sequence[49] = -65220;
-  device.sequencer.sampler.settings.sequence[50] = -64277;
-  device.sequencer.sampler.settings.sequence[51] = -62714;
-  device.sequencer.sampler.settings.sequence[52] = -60547;
-  device.sequencer.sampler.settings.sequence[53] = -57798;
-  device.sequencer.sampler.settings.sequence[54] = -54491;
-  device.sequencer.sampler.settings.sequence[55] = -50660;
-  device.sequencer.sampler.settings.sequence[56] = -46341;
-  device.sequencer.sampler.settings.sequence[57] = -41576;
-  device.sequencer.sampler.settings.sequence[58] = -36410;
-  device.sequencer.sampler.settings.sequence[59] = -30893;
-  device.sequencer.sampler.settings.sequence[60] = -25080;
-  device.sequencer.sampler.settings.sequence[61] = -19024;
-  device.sequencer.sampler.settings.sequence[62] = -12785;
-  device.sequencer.sampler.settings.sequence[63] = -6424;
-  
-  device.sequencer.output.analog.settings.enabled = 1;
-  device.sequencer.output.logic.settings.enabled = 0;
-  device.sequencer.output.analog.settings.transfer.points = 16;
-  device.sequencer.output.analog.settings.transfer.code[0] = 0x0;
-  device.sequencer.output.analog.settings.transfer.voltage[0] = -0x1e0000; //-30.0V
-  device.sequencer.output.analog.settings.transfer.code[1] = 0x1100;
-  device.sequencer.output.analog.settings.transfer.voltage[1] = -0x1a0000; //-26.0V
-  device.sequencer.output.analog.settings.transfer.code[2] = 0x2200;
-  device.sequencer.output.analog.settings.transfer.voltage[2] = -0x160000; //-22.0V
-  device.sequencer.output.analog.settings.transfer.code[3] = 0x3300;
-  device.sequencer.output.analog.settings.transfer.voltage[3] = -0x120000; //-18.0V
-  device.sequencer.output.analog.settings.transfer.code[4] = 0x4440;
-  device.sequencer.output.analog.settings.transfer.voltage[4] = -0xe0000; //-14.0V
-  device.sequencer.output.analog.settings.transfer.code[5] = 0x5540;
-  device.sequencer.output.analog.settings.transfer.voltage[5] = -0xa0000; //-10.0V
-  device.sequencer.output.analog.settings.transfer.code[6] = 0x6640;
-  device.sequencer.output.analog.settings.transfer.voltage[6] = -0x60000; //-6.0V
-  device.sequencer.output.analog.settings.transfer.code[7] = 0x7740;
-  device.sequencer.output.analog.settings.transfer.voltage[7] = -0x20000; //-2.0V
-  device.sequencer.output.analog.settings.transfer.code[8] = 0x8880;
-  device.sequencer.output.analog.settings.transfer.voltage[8] = 0x20000; //2.0V
-  device.sequencer.output.analog.settings.transfer.code[9] = 0x9980;
-  device.sequencer.output.analog.settings.transfer.voltage[9] = 0x60000; //6.0V
-  device.sequencer.output.analog.settings.transfer.code[10] = 0xaa80;
-  device.sequencer.output.analog.settings.transfer.voltage[10] = 0xa0000; //10.0V
-  device.sequencer.output.analog.settings.transfer.code[11] = 0xbb80;
-  device.sequencer.output.analog.settings.transfer.voltage[11] = 0xe0000; //14.0V
-  device.sequencer.output.analog.settings.transfer.code[12] = 0xccc0;
-  device.sequencer.output.analog.settings.transfer.voltage[12] = 0x120000; //18.0V
-  device.sequencer.output.analog.settings.transfer.code[13] = 0xddc0;
-  device.sequencer.output.analog.settings.transfer.voltage[13] = 0x160000; //22.0V
-  device.sequencer.output.analog.settings.transfer.code[14] = 0xeec0;
-  device.sequencer.output.analog.settings.transfer.voltage[14] = 0x1a0000; //26.0V
-  device.sequencer.output.analog.settings.transfer.code[15] = 0xffc0;
-  device.sequencer.output.analog.settings.transfer.voltage[15] = 0x1e0000; //30.0V
-}
-
-void InitSequencerState(void){
-  device.sequencer.sampler.state.enabled = device.sequencer.sampler.settings.enabled;
-  device.sequencer.sampler.state.amplitude = device.sequencer.sampler.settings.amplitude;
-  device.sequencer.sampler.state.position[0] = device.sequencer.sampler.settings.position[0]; //starting output sample position
-  device.sequencer.sampler.state.position[1] = device.sequencer.sampler.settings.position[1]; //starting reference (delayed) sample position
-  device.sequencer.sampler.state.sample[0] = device.sequencer.sampler.settings.sequence[device.sequencer.sampler.state.position[0]];
-  device.sequencer.sampler.state.sample[1] = device.sequencer.sampler.settings.sequence[device.sequencer.sampler.state.position[1]];
-  device.sequencer.sampler.state.voltage = device.sequencer.sampler.state.amplitude * device.sequencer.sampler.state.sample[0];
-  
-  device.sequencer.output.analog.state.enabled = device.sequencer.output.analog.settings.enabled;
-  device.sequencer.output.logic.state.enabled = device.sequencer.output.logic.settings.enabled;
-}
-
-void DeviceStartSequencer(void){
-  if (device.sequencer.output.logic.state.enabled) {
-    //Setup P0.26: GPIO output
-    LPC_PINCON->PINSEL1  &= ~(3<<20); //P0.26 is GPIO pin (write 00b in bits 21:20 of PINSEL1)
-    LPC_PINCON->PINMODE1 |=  (3<<20); //P0.26 pull-down resistor on (write 11b in bits 21:20 of PINMODE0)
-    LPC_GPIO0->FIODIR    |=  (1<<26); //P0.26 is output (write 1b in bit 4 of FIODIR)
-    LPC_GPIO0->FIOSET    |=  (1<<26); //off
-  } else if (device.sequencer.output.analog.state.enabled) {
-    LPC_SC->PCLKSEL0 &= ~(0x3<<22);  //00b CLK/4; 01b CLK; 10b CLK/2; 11b CLK/8
-    //Pin 0.26 function select AOUT (10b)
-    LPC_PINCON->PINSEL1  &= ~(3<<20);
-    LPC_PINCON->PINSEL1 |=  0x2 << 20; //P0.26 is AOUT pin (write 10b in bits 21:20 of PINSEL1)
-  }
-}
-
-int32_t sequencerInterpolate(int32_t a,int32_t a1,int32_t a2,int32_t b1,int32_t b2) {
-  int32_t ma, mb;
-  while (1) {
-    if (a1 == a) return b1;
-    if (a2 == a) return b2;
-                
-    ma = (a1 + a2) >> 1;
-    mb = (b1 + b2) >> 1;
-      
-    if (a < ma) {
-      if (a2 == ma) return mb;
-      if (b1 == mb) return mb;
-      a2 = ma; b2 = mb;
-    } else if (a > ma) {
-      if (a1 == ma) return mb;
-      if (b2 == mb) return mb;
-      a1 = ma; b1 = mb;
-    } else return mb;
-  }
-}
-
-int32_t sequencerOutput(uint32_t voltage) {
-  int32_t v1, v2;
-  for (uint8_t i = 1; i < device.sequencer.output.analog.settings.transfer.points; i++) {
-    v1 = device.sequencer.output.analog.settings.transfer.voltage[i - 1];
-    if (voltage < v1) {
-      return device.sequencer.output.analog.settings.transfer.code[i - 1];
-    }
-
-    v2 = device.sequencer.output.analog.settings.transfer.voltage[i];
-    if (voltage < v2) {
-      int32_t c1 = device.sequencer.output.analog.settings.transfer.code[i - 1];
-      int32_t c2 = device.sequencer.output.analog.settings.transfer.code[i];
-      return sequencerInterpolate(voltage, v1, v2, c1, c2);
-    }
-  }
-  return device.sequencer.output.analog.settings.transfer.code[device.sequencer.output.analog.settings.transfer.points - 1];
-}
-
-void sequencerProcess(void){
-  //Sample
-  device.sequencer.sampler.state.sample[0] = device.sequencer.sampler.settings.sequence[device.sequencer.sampler.state.position[0]];
-  device.sequencer.sampler.state.sample[1] = device.sequencer.sampler.settings.sequence[device.sequencer.sampler.state.position[1]];
-  device.sequencer.sampler.state.voltage = device.sequencer.sampler.state.amplitude * device.sequencer.sampler.state.sample[0];
-  //Set output
-  if (device.sequencer.output.logic.state.enabled) {
-    if (device.sequencer.sampler.state.sample[0] > 0) {
-      LPC_GPIO0->FIOCLR |= (1<<26); //1
-    } else {
-      LPC_GPIO0->FIOSET |= (1<<26); //0
-    }
-  } else if (device.sequencer.output.analog.state.enabled) {
-    device.sequencer.output.analog.state.voltage = device.sequencer.sampler.state.voltage;
-    //Warning! bit 16 - 0/1: Update rate 1MHz/400kHz; bits 15...6 - code; bits 5...0 - reserved, write 000000
-    LPC_DAC->DACR = sequencerOutput(device.sequencer.output.analog.state.voltage);
-    //LPC_DAC->CR = sequencerOutput(device.sequencer.output.analog.state.voltage);
-  }
-  //Process sequencer state
-  device.sequencer.sampler.state.position[0]++;
-  if (device.sequencer.sampler.state.position[0] == 64) device.sequencer.sampler.state.position[0] = 0;
-  device.sequencer.sampler.state.position[1]++;
-  if (device.sequencer.sampler.state.position[1] == 64) device.sequencer.sampler.state.position[1] = 0;
-}
\ No newline at end of file