123
Fork of LG by
DeviceSequencer.c
- Committer:
- Diletant
- Date:
- 2016-06-19
- Revision:
- 173:7f938afb0447
- Child:
- 197:7a05523bf588
File content as of revision 173:7f938afb0447:
#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; }