This lib is supposed to be used as a sensor's calibration or control program. This makes Cubic Spline Model from some sample plots(sets of (value, voltage)), and then discretize the model (dividing the range of voltage into some steps) in order to use the calibrated model data without getting the INVERSE function.

Committer:
aktk
Date:
Mon Jun 06 14:44:15 2016 +0000
Revision:
8:9eaa9772e1e7
Child:
11:d60fb729eacf
Debugged SPI wrapper.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
aktk 8:9eaa9772e1e7 1 #include "TRP105FS_SPIWrapper.h"
aktk 8:9eaa9772e1e7 2
aktk 8:9eaa9772e1e7 3 //
aktk 8:9eaa9772e1e7 4 // Make instance of static member
aktk 8:9eaa9772e1e7 5 //
aktk 8:9eaa9772e1e7 6 SPI
aktk 8:9eaa9772e1e7 7 SPI_TRP105FS::spi(p5, p6, p7); // mosi(out), miso(in), sclk(clock)
aktk 8:9eaa9772e1e7 8
aktk 8:9eaa9772e1e7 9 DigitalOut
aktk 8:9eaa9772e1e7 10 SPI_TRP105FS::cs(p8); // cs (the chip select signal)
aktk 8:9eaa9772e1e7 11
aktk 8:9eaa9772e1e7 12 //
aktk 8:9eaa9772e1e7 13 // For SPI, Define static method
aktk 8:9eaa9772e1e7 14 //
aktk 8:9eaa9772e1e7 15 int
aktk 8:9eaa9772e1e7 16 SPI_TRP105FS::ADread(int channel)
aktk 8:9eaa9772e1e7 17 {
aktk 8:9eaa9772e1e7 18 int command_high=0x06|((channel&0x04)>>2);
aktk 8:9eaa9772e1e7 19 int command_low=(channel&0x03)<<14;
aktk 8:9eaa9772e1e7 20 __disable_irq(); // 割り込み禁止
aktk 8:9eaa9772e1e7 21 cs = 0;
aktk 8:9eaa9772e1e7 22 spi.write(command_high);
aktk 8:9eaa9772e1e7 23 int resultbyte=spi.write(command_low) & 0xfff;
aktk 8:9eaa9772e1e7 24 cs = 1;
aktk 8:9eaa9772e1e7 25 __enable_irq(); // 割り込み許可
aktk 8:9eaa9772e1e7 26 return(resultbyte);
aktk 8:9eaa9772e1e7 27 }
aktk 8:9eaa9772e1e7 28
aktk 8:9eaa9772e1e7 29 //
aktk 8:9eaa9772e1e7 30 // Define Constructor
aktk 8:9eaa9772e1e7 31 //
aktk 8:9eaa9772e1e7 32 SPI_TRP105FS::SPI_TRP105FS()
aktk 8:9eaa9772e1e7 33 :channel(0)
aktk 8:9eaa9772e1e7 34 ,nsample(5)
aktk 8:9eaa9772e1e7 35 ,trp(TRP105FS(nsample))
aktk 8:9eaa9772e1e7 36 ,filename("\0")
aktk 8:9eaa9772e1e7 37 {}
aktk 8:9eaa9772e1e7 38
aktk 8:9eaa9772e1e7 39 SPI_TRP105FS::SPI_TRP105FS(unsigned int arg_ch)
aktk 8:9eaa9772e1e7 40 :channel(arg_ch)
aktk 8:9eaa9772e1e7 41 ,nsample(5)
aktk 8:9eaa9772e1e7 42 ,trp(TRP105FS(nsample))
aktk 8:9eaa9772e1e7 43 ,filename("\0")
aktk 8:9eaa9772e1e7 44 {}
aktk 8:9eaa9772e1e7 45
aktk 8:9eaa9772e1e7 46 void
aktk 8:9eaa9772e1e7 47 SPI_TRP105FS::setSample(unsigned short arg_x)
aktk 8:9eaa9772e1e7 48 {
aktk 8:9eaa9772e1e7 49 trp.setSample(arg_x, (unsigned short)ADread(channel));
aktk 8:9eaa9772e1e7 50 }
aktk 8:9eaa9772e1e7 51
aktk 8:9eaa9772e1e7 52 void
aktk 8:9eaa9772e1e7 53 SPI_TRP105FS::calibrate()
aktk 8:9eaa9772e1e7 54 {
aktk 8:9eaa9772e1e7 55 trp.calibrate();
aktk 8:9eaa9772e1e7 56 }
aktk 8:9eaa9772e1e7 57
aktk 8:9eaa9772e1e7 58 unsigned short
aktk 8:9eaa9772e1e7 59 SPI_TRP105FS::getDistance()
aktk 8:9eaa9772e1e7 60 {
aktk 8:9eaa9772e1e7 61 return trp.getDistance((unsigned short)ADread(channel));
aktk 8:9eaa9772e1e7 62 }
aktk 8:9eaa9772e1e7 63
aktk 8:9eaa9772e1e7 64 unsigned int
aktk 8:9eaa9772e1e7 65 SPI_TRP105FS::getChannel()
aktk 8:9eaa9772e1e7 66 {
aktk 8:9eaa9772e1e7 67 return channel;
aktk 8:9eaa9772e1e7 68 }
aktk 8:9eaa9772e1e7 69
aktk 8:9eaa9772e1e7 70 unsigned int
aktk 8:9eaa9772e1e7 71 SPI_TRP105FS::getNsample()
aktk 8:9eaa9772e1e7 72 {
aktk 8:9eaa9772e1e7 73 return nsample;
aktk 8:9eaa9772e1e7 74 }
aktk 8:9eaa9772e1e7 75
aktk 8:9eaa9772e1e7 76 void
aktk 8:9eaa9772e1e7 77 SPI_TRP105FS::savedata()
aktk 8:9eaa9772e1e7 78 {
aktk 8:9eaa9772e1e7 79 if (filename[0] == '\0')
aktk 8:9eaa9772e1e7 80 sprintf(filename, "SENSOR%02d.SAV", channel);
aktk 8:9eaa9772e1e7 81 trp.saveSetting(filename);
aktk 8:9eaa9772e1e7 82 }
aktk 8:9eaa9772e1e7 83
aktk 8:9eaa9772e1e7 84 void
aktk 8:9eaa9772e1e7 85 SPI_TRP105FS::loaddata()
aktk 8:9eaa9772e1e7 86 {
aktk 8:9eaa9772e1e7 87 if (filename[0] == '\0')
aktk 8:9eaa9772e1e7 88 sprintf(filename, "SENSOR%02d.SAV", channel);
aktk 8:9eaa9772e1e7 89 trp.loadSetting(filename);
aktk 8:9eaa9772e1e7 90 }
aktk 8:9eaa9772e1e7 91 void
aktk 8:9eaa9772e1e7 92 SPI_TRP105FS::printCalibrationiLOG()
aktk 8:9eaa9772e1e7 93 {
aktk 8:9eaa9772e1e7 94 trp.printOutData("ADLOG.TXT");
aktk 8:9eaa9772e1e7 95 trp.printThresholds();
aktk 8:9eaa9772e1e7 96 }