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.
TRP105FS_SPIWrapper.cpp@8:9eaa9772e1e7, 2016-06-06 (annotated)
- 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?
User | Revision | Line number | New 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 | } |