-
Notifications
You must be signed in to change notification settings - Fork 1
/
Copy pathqdn_interpolation.cpp
63 lines (53 loc) · 2.7 KB
/
qdn_interpolation.cpp
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
/**************************************************************************
*
* Copyright (c) 2013, Qromodyn Corporation
* All rights reserved.
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions are met:
*
* 1. Redistributions of source code must retain the above copyright notice, this
* list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright notice,
* this list of conditions and the following disclaimer in the documentation
* and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
* WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
* DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR
* ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
* ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*
* The views and conclusions contained in the software and documentation are those
* of the authors and should not be interpreted as representing official policies,
* either expressed or implied, of the FreeBSD Project.
**************************************************************************/
////////////////////////////////////////////////////////////////////////////
//
// data calculated from NTC data sheets from Vishay, see ntc_adc_table.xlsx in doc folder.
#include "qdn_project.h"
#include "qdn_interpolation.h"
#ifndef ADC_SIZE
#error please define ADC_SIZE in your qdn_project.h. Should be the bit width of the ADC, assuming it is right-aligned.
#endif
extern "C"
uint16_t QDN_InterpolateADC(uint16_t adc, const int16_t* table, int logTableSize) {
uint16_t t;
uint8_t index;
int logDelta;
int delta;
if (adc >= (1<<ADC_SIZE)) {
// value too big to read from table! a bogus ADC measurement, no doubt.
return 0;
}
logDelta = ADC_SIZE - logTableSize;
index = (adc >> (logDelta)); // get the table entry from the high bits
delta = (1L<<(logDelta));
adc &= (delta-1); // get low bits to interpolate between table entries
t = (table[index] * (delta-adc) + table[index+1] * adc) >> logDelta;
return t;
}