-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathTenso_sensor.ino
98 lines (72 loc) · 2.13 KB
/
Tenso_sensor.ino
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
#include <Q2HX711.h>
# HX711 Library source https://github.com/ConnectedHealthFoundry/Q2HX711
const bool DEBUG = false;
const byte hx711_data_pin = A2;
const byte hx711_clock_pin = A3;
const int probe_pin = 7;
long trigger = 13000; //Weight difference trigger. Lower is better
long weight, prev_weight, trigger_weight = 0;
bool is_pressed = false;
//Filter parameters
float FK = 0.9;
int tolerance = 3000; //
int values_count = 5; //HX711 speed is 80Hz or near this value. To get 10 values the sensor need around 120ms.
long timest = millis();
Q2HX711 hx711(hx711_data_pin, hx711_clock_pin);
//Get filtered values from HX711
long getSensorValue() { //
long acc_x_raw, acc_x, acc_xf;
for (int i = 0; i < values_count; i++) {
acc_x_raw = hx711.read();
acc_x = acc_x_raw - tolerance/1.0;
acc_xf = (1-FK)*acc_xf + FK*acc_x;
}
return acc_xf;
}
void setup() {
pinMode(probe_pin, OUTPUT);
digitalWrite(probe_pin, LOW);
Serial.begin(115200);
delay(1000);
prev_weight = weight = getSensorValue();
Serial.println(prev_weight);
}
void loop() {
weight = getSensorValue();
if (DEBUG) {
if (timest+500 <= millis()) {
char buffer [50];
sprintf (buffer, "current weight! [%li] [%li]", weight, prev_weight);
Serial.println(buffer);
timest = millis();
}
}
if (is_pressed) {
if (DEBUG) {
char buffer [50];
sprintf (buffer, "Current [%li] trigger [%li]", weight, trigger_weight);
Serial.println(buffer);
}
if (trigger_weight >= weight) {
if (DEBUG) {
char buffer [50];
sprintf (buffer, "Trigger released! [%li]", weight);
Serial.println(buffer);
}
digitalWrite(probe_pin, LOW);
is_pressed = false;
}
} else {
if ((weight - prev_weight) >= trigger) {
if (DEBUG) {
char buffer [50];
sprintf (buffer, "Trigger fired! [%li]", weight);
Serial.println(buffer);
}
digitalWrite(probe_pin, HIGH);
is_pressed = true;
trigger_weight = weight;
}
prev_weight = weight;
}
}