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
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
|
#include <Heating/Sensors/CurrentLoopTemperatureSensor.h>
#include "TemperatureSensor.h"
#include "Thermistor.h"
#include "ThermocoupleSensor31855.h"
#include "ThermocoupleSensor31856.h"
#include "RtdSensor31865.h"
#include "GCodes/GCodeBuffer.h"
#if HAS_CPU_TEMP_SENSOR
#include "CpuTemperatureSensor.h"
#endif
#if SUPPORT_DHT_SENSOR
#include "DhtSensor.h"
#endif
#if HAS_SMART_DRIVERS
#include "TmcDriverTemperatureSensor.h"
#endif
// Constructor
TemperatureSensor::TemperatureSensor(unsigned int chan, const char *t) : sensorChannel(chan), sensorType(t), heaterName(nullptr) {}
// Virtual destructor
TemperatureSensor::~TemperatureSensor()
{
delete heaterName;
}
// Set the name - normally called only once, so we allow heap memory to be allocated
void TemperatureSensor::SetHeaterName(const char *newName)
{
// Change the heater name in a thread-safe manner
const char *oldName = heaterName;
heaterName = nullptr;
delete oldName;
if (newName != nullptr && strlen(newName) != 0)
{
char * const temp = new char[strlen(newName) + 1];
strcpy(temp, newName);
heaterName = temp;
}
}
// Default implementation of Configure, for sensors that have no configurable parameters
GCodeResult TemperatureSensor::Configure(unsigned int mCode, unsigned int heater, GCodeBuffer& gb, const StringRef& reply)
{
bool seen = false;
if (mCode == 305)
{
TryConfigureHeaterName(gb, seen);
if (!seen && !gb.Seen('X'))
{
// No parameters provided, so report the current configuration
CopyBasicHeaterDetails(heater, reply);
}
}
return GCodeResult::ok;
}
void TemperatureSensor::CopyBasicHeaterDetails(unsigned int heater, const StringRef& reply) const
{
reply.printf("Heater %u", heater);
if (heaterName != nullptr)
{
reply.catf(" (%s)", heaterName);
}
reply.catf(" uses %s sensor channel %u", sensorType, sensorChannel);
}
// Configure then heater name, if it is provided
void TemperatureSensor::TryConfigureHeaterName(GCodeBuffer& gb, bool& seen)
{
String<MaxHeaterNameLength> buf;
bool localSeen = false;
gb.TryGetQuotedString('S', buf.GetRef(), localSeen);
if (localSeen)
{
SetHeaterName(buf.c_str());
seen = true;
}
}
// Factory method
TemperatureSensor *TemperatureSensor::Create(unsigned int channel)
{
TemperatureSensor *ts = nullptr;
if (channel < Heaters)
{
ts = new Thermistor(channel, false);
}
else if (FirstPT1000Channel <= channel && channel < FirstPT1000Channel + Heaters)
{
ts = new Thermistor(channel, true);
}
else if (FirstMax31855ThermocoupleChannel <= channel && channel < FirstMax31855ThermocoupleChannel + MaxSpiTempSensors)
{
ts = new ThermocoupleSensor31855(channel);
}
else if (FirstMax31856ThermocoupleChannel <= channel && channel < FirstMax31856ThermocoupleChannel + MaxSpiTempSensors)
{
ts = new ThermocoupleSensor31856(channel);
}
else if (FirstRtdChannel <= channel && channel < FirstRtdChannel + MaxSpiTempSensors)
{
ts = new RtdSensor31865(channel);
}
else if (FirstLinearAdcChannel <= channel && channel < FirstLinearAdcChannel + MaxSpiTempSensors)
{
ts = new CurrentLoopTemperatureSensor(channel);
}
#if SUPPORT_DHT_SENSOR
else if (FirstDhtTemperatureChannel <= channel && channel < FirstDhtTemperatureChannel + MaxSpiTempSensors)
{
ts = new DhtTemperatureSensor(channel);
}
else if (FirstDhtHumidityChannel <= channel && channel < FirstDhtHumidityChannel + MaxSpiTempSensors)
{
ts = new DhtHumiditySensor(channel);
}
#endif
#if HAS_CPU_TEMP_SENSOR
else if (channel == CpuTemperatureSenseChannel)
{
ts = new CpuTemperatureSensor(channel);
}
#endif
#if HAS_SMART_DRIVERS
else if (channel >= FirstTmcDriversSenseChannel && channel < FirstTmcDriversSenseChannel + NumTmcDriversSenseChannels)
{
ts = new TmcDriverTemperatureSensor(channel);
}
#endif
if (ts != nullptr)
{
ts->Init();
}
return ts;
}
// Shared function used by two derived classes
// pt100rtd list of resistances v temperature
//
// DIN 43760 / IEC 751 resistance values (ohms) were multiplied by 100 and
// converted to 16 bit unsigned integers with no loss of accuracy.
//
// Examples:
// 1852 represents 18.52 ohms and corresponds to a temperature of -200C.
// 10000 ==> 100.00 ohms @ 0C
// 13851 ==> 138.51 ohms @ 100C
const float CelsiusMin = -100.0; // starting temperature of the temp table below
const float CelsiusInterval = 10.0;
static const uint16_t tempTable[] =
{
6026, 6430, 6833, 7233, 7633, 8031, 8427, 8822, 9216, 9609,
10000, 10390, 10779, 11167, 11554, 11940, 12324, 12708, 13090, 13471,
13851, 14229, 14607, 14983, 15358, 15733, 16105, 16477, 16848, 17217,
17586, 17953, 18319, 18684, 19047, 19410, 19771, 20131, 20490, 20848,
21205, 21561, 21915, 22268, 22621, 22972, 23321, 23670, 24018, 24364,
24709, 25053, 25396, 25738, 26078, 26418, 26756, 27093, 27429, 27764,
28098, 28430, 28762, 29092, 29421, 29749, 30075, 30401, 30725, 31048,
31371, 31692, 32012, 32330, 32648, 32964, 33279, 33593, 33906, 34218,
34528, 34838, 35146, 35453, 35759, 36064, 36367, 36670, 36971, 37271,
37570, 37868, 38165, 38460, 38755, 39048
};
const size_t NumTempTableEntries = sizeof(tempTable)/sizeof(tempTable[0]);
/*static*/ TemperatureError TemperatureSensor::GetPT100Temperature(float& t, uint16_t ohmsx100)
{
// Formally-verified binary search routine, adapted from one of the eCv examples
size_t low = 0u, high = NumTempTableEntries;
while (high > low)
keep(low <= high; high <= NumTempTableEntries)
keep(low == 0u || tempTable[low - 1u] < ohmsx100)
keep(high == NumTempTableEntries || ohmsx100 <= tempTable[high])
decrease(high - low)
{
size_t mid = (high - low)/2u + low; // get the mid point, avoiding arithmetic overflow
if (ohmsx100 <= tempTable[mid])
{
high = mid;
}
else
{
low = mid + 1u;
}
}
assert(low <= NumTempTableEntries);
assert(low == 0 || tempTable[low - 1] < ohmsx100);
assert(low == NumTempTableEntries || ohmsx100 <= tempTable[low]);
if (low == 0) // if off the bottom of the table
{
return TemperatureError::shortCircuit;
}
if (low >= NumTempTableEntries) // if off the top of the table
{
return TemperatureError::openCircuit;
}
const float temperatureFraction = (float)(ohmsx100 - tempTable[low - 1])/(float)(tempTable[low] - tempTable[low - 1]);
t = CelsiusInterval * (low - 1 + temperatureFraction) + CelsiusMin;
//debugPrintf("raw %f low %u temp %f\n", ohmsx100, low, t);
return TemperatureError::success;
}
// End
|
