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
|
#include "WConstants.h"
#include "ThermoplastExtruder.h"
// Pick up the thermistor table from the file - makes it easier to customise
// the code for different thermistors.
#include "ThermistorTable.h"
/*!
motor_dir_pin must be a digital output.
motor_pwm_pin and heater_pin must be PWM capable outputs.
thermistor_pin must be an analog input.
*/
ThermoplastExtruder::ThermoplastExtruder(byte motor_dir_pin, byte motor_pwm_pin,
byte heater_pin, byte cooler_pin, byte thermistor_pin, byte valve_dir_pin,
byte valve_enable_pin)
{
this->motor_dir_pin = motor_dir_pin;
this->motor_pwm_pin = motor_pwm_pin;
this->valve_dir_pin = valve_dir_pin;
this->valve_enable_pin = valve_enable_pin;
this->heater_pin = heater_pin;
this->cooler_pin = cooler_pin;
this->thermistor_pin = thermistor_pin;
pinMode(this->motor_dir_pin, OUTPUT);
pinMode(this->motor_pwm_pin, OUTPUT);
pinMode(this->heater_pin, OUTPUT);
pinMode(this->valve_dir_pin, OUTPUT);
pinMode(this->valve_enable_pin, OUTPUT);
this->getTemperature();
this->setSpeed(0);
this->setDirection(true);
//init our temp stuff.
this->target_celsius = 0;
this->max_celsius = 0;
this->heater_low = 0;
this->heater_high = 0;
}
/*!
Sets the motor speed from 0-255 (0 is off).
*/
void ThermoplastExtruder::setSpeed(byte speed)
{
this->motor_pwm = speed;
analogWrite(this->motor_pwm_pin, this->motor_pwm);
}
void ThermoplastExtruder::setCooler(byte speed)
{
this->cooler_pwm = speed;
analogWrite(this->cooler_pin, this->cooler_pwm);
}
/*!
Sets the motor direction (true = forward, false = backward)
*/
void ThermoplastExtruder::setDirection(bool dir)
{
this->motor_dir = dir;
digitalWrite(this->motor_dir_pin, this->motor_dir);
}
/*!
Pulse the valve to open or close it. dir == true: open; dir == false: closed
*/
void ThermoplastExtruder::setValve(bool dir, byte pulse_time)
{
digitalWrite(this->valve_dir_pin, dir);
digitalWrite(this->valve_enable_pin, 1);
delay(2*(int)pulse_time);
digitalWrite(this->valve_enable_pin, 0);
}
void ThermoplastExtruder::setTemperature(int temp)
{
this->target_celsius = temp;
this->max_celsius = (int)((float)temp * 1.1);
}
/**
* Samples the temperature and converts it to degrees celsius.
* Returns degrees celsius.
*/
int ThermoplastExtruder::getTemperature()
{
this->raw_temperature = analogRead(thermistor_pin);
this->current_celsius = this->calculateTemperatureFromRaw(this->raw_temperature);
return this->current_celsius;
}
/**
* Samples the temperature and converts it to degrees celsius.
* Returns degrees celsius.
*/
int ThermoplastExtruder::calculateTemperatureFromRaw(int raw)
{
int celsius = 0;
byte i;
for (i=1; i<NUMTEMPS; i++)
{
if (temptable[i][0] > raw)
{
celsius = temptable[i-1][1] +
(raw - temptable[i-1][0]) *
(temptable[i][1] - temptable[i-1][1]) /
(temptable[i][0] - temptable[i-1][0]);
if (celsius > 255)
celsius = 255;
break;
}
}
// Overflow: We just clamp to 0 degrees celsius
if (i == NUMTEMPS)
celsius = 0;
return celsius;
}
/*!
Manages motor and heater based on measured temperature:
o If temp is too low, don't start the motor
o Adjust the heater power to keep the temperature at the target
*/
void ThermoplastExtruder::manageTemperature()
{
//make sure we know what our temp is.
this->getTemperature();
//put the heater into high mode if we're not at our target.
if (current_celsius < target_celsius)
{
analogWrite(heater_pin, heater_high);
}
//put the heater on low if we're at our target.
else if (current_celsius < max_celsius)
{
analogWrite(heater_pin, heater_low);
}
//turn the heater off if we're above our max.
else
{
analogWrite(heater_pin, 0);
}
}
|
