Cách dùng cảm biến gập với một Arduino
Hoặc xem mọi bài học.
- 526linh kiện trên bàn làm mạch
- 46bo mạch đang chạy
- 1.00xthời gian thực, trên mọi bo mạch
Cảm biến gập là một dải có điện trở tăng lên khi bị gập. Nối một chân vào 5 V và chân kia vào A0, đặt điện trở 47k từ A0 xuống GND, rồi đọc bằng analogRead(). Khi phẳng, nó đọc cao; khi gập, nó đọc thấp hơn. Đây chính là linh kiện bên trong mọi găng tay điều khiển tay robot.
Mạch ở trên là một cảm biến gập 2.2 inch với điện trở 47k trên một Uno. Nhấn Chạy và kéo thanh trượt để gập dải cảm biến. Khi phẳng, serial monitor in "A0 = 668 (3264 mV)". Ở góc vuông nó đọc "A0 = 439 (2145 mV)", và gập hẳn lại thì "A0 = 327 (1598 mV)".
Dưới đây là cách dải cảm biến hoạt động, cách nối dây, hai cách biến giá trị đọc thành góc, một servo bắt chước ngón tay bạn, và cách chọn điện trở.
Những gì bạn cần
- Một Arduino Uno
- Một cảm biến gập, ví dụ dải Spectra Symbol 2.2 inch hoặc 4.5 inch
- Một điện trở 47k (vàng, tím, cam)
- Một servo, cho ngón tay robot
- Một breadboard và dây cắm
Đi dây
| Linh kiện và chân | Nối tới | Ghi chú |
|---|---|---|
| Cảm biến gập, một chân bất kỳ | 5 V | Nó không phân cực, nhưng chỉ gập được theo một chiều |
| Cảm biến gập, chân còn lại | A0 | |
| Điện trở 47k | Từ A0 sang GND | Tạo thành mạch phân áp |
| Tín hiệu servo | Chân 9 | Cho ngón tay robot; đỏ vào 5 V, nâu vào GND |
Cảm biến gập hoạt động như thế nào
Một mặt của dải được in bằng mực carbon. Gập nó sao cho lớp mực nằm ở phía ngoài đường cong, lớp mực nứt thành các mảnh nhỏ hơn, nên điện trở tăng lên: khoảng 25k khi phẳng, 62.5k ở 90 độ và 100k khi gập hẳn, trong trình mô phỏng. Gập ngược chiều thì dải cảm biến thật gần như không đổi, nên hãy lắp nó với mặt in hướng ra ngoài.
Dải cảm biến là nửa trên của mạch phân áp, nên điện trở càng lớn nghĩa là điện áp trên A0 càng thấp. Đó là lý do giá trị đọc giảm khi bạn gập.
Từ giá trị đọc sang độ với map()
Cách nhanh là đo giá trị khi phẳng và khi gập hẳn, rồi để map() dãn nó ra 0 đến 180. Khi phẳng nó in "668 -> 0 degrees" và khi gập hẳn "327 -> 180 degrees". Tới đây vẫn ổn. Nhưng ở góc vuông nó in "439 -> 120 degrees", chứ không phải 90.
Điện trở của dải tăng theo tuyến tính với độ gập, nhưng mạch phân áp không biến điện trở thành điện áp theo tuyến tính, nên map() làm lệch phần giữa. Với một găng tay mở và đóng bàn tay, điều đó chẳng sao. Còn với một góc bạn muốn in ra, hãy dùng sketch tiếp theo.
const int FLAT = 668; // the reading with the strip flat
const int BENT = 327; // and folded right over
void setup() {
Serial.begin(9600);
}
void loop() {
int reading = analogRead(A0);
int angle = map(reading, FLAT, BENT, 0, 180);
angle = constrain(angle, 0, 180);
Serial.print(reading);
Serial.print(" -> ");
Serial.print(angle);
Serial.println(" degrees");
delay(500);
}Mở sketch này trong trình soạn codeChỉ riêng phần code: trình soạn code sẽ tự đặt bo mạch và các linh kiện mà nó đọc được từ sketch.
Độ tính từ điện trở
Tính điện trở của dải từ mạch phân áp trước, R = 47000 * (1023 - raw) / raw, rồi biến điện trở thành độ. Khi phẳng nó in "24977 ohms -> 0 degrees", ở góc vuông "62523 ohms -> 90 degrees" và khi gập hẳn "100036 ohms -> 180 degrees". Ở 45 độ nó in 44, chính xác hết mức mà các bậc của ADC cho phép.
Trên dải cảm biến thật, hãy đo FLAT_OHMS và BENT_OHMS với dải của chính bạn, vì mỗi chiếc hơi khác nhau một chút.
const long R_FIXED = 47000; // the resistor from A0 to GND
const long FLAT_OHMS = 25000; // the strip flat
const long BENT_OHMS = 100000; // the strip folded over
void setup() {
Serial.begin(9600);
}
void loop() {
int raw = analogRead(A0);
long ohms = R_FIXED * (1023 - raw) / raw;
long angle = (ohms - FLAT_OHMS) * 180 / (BENT_OHMS - FLAT_OHMS);
angle = constrain(angle, 0, 180);
Serial.print(ohms);
Serial.print(" ohms -> ");
Serial.print(angle);
Serial.println(" degrees");
delay(500);
}Mở sketch này trong trình soạn codeChỉ riêng phần code: trình soạn code sẽ tự đặt bo mạch và các linh kiện mà nó đọc được từ sketch.
Một ngón servo bắt chước ngón của bạn
Thêm một servo vào chân 9 là dải cảm biến có thể điều khiển nó. Đây là một ngón của bàn tay robot: dán dải cảm biến dọc theo ngón tay bạn và servo sẽ đi theo khi bạn gập. Khi phẳng, servo nằm ở 0 độ, và khi gập hẳn nó lên tới 180.
Nó dùng bản map(), nên dải gập 90 độ đặt servo ở 120. Với bàn tay thì ổn; ngón vẫn khép khi ngón của bạn khép. Năm dải trên A0 đến A4 và năm servo tạo thành cả bàn tay; dự án bàn tay robot làm đúng như vậy trên một Mega.
#include <Servo.h>
Servo finger;
void setup() {
finger.attach(9);
}
void loop() {
int reading = analogRead(A0);
int angle = map(reading, 668, 327, 0, 180);
finger.write(constrain(angle, 0, 180));
delay(20);
}Mở sketch này trong trình soạn codeChỉ riêng phần code: trình soạn code sẽ tự đặt bo mạch và các linh kiện mà nó đọc được từ sketch.
Chọn điện trở
Điện trở tốt nhất là giá trị gần với điện trở tự thân của dải cảm biến trong toàn dải của nó. Với điện trở 47k, số đọc đi từ 668 khi thẳng lên 327 khi gập, chênh lệch 341 đơn vị. Điện trở 10k chỉ chênh từ 292 xuống 93, còn 100k từ 818 xuống 512. Chênh lệch càng lớn thì góc càng mượt.
Những gì phần mô phỏng bỏ qua
Mọi dải cảm biến ở đây đều là loại điển hình: 25k khi thẳng và 100k khi gập, điện trở thay đổi tức thì theo thanh trượt. Dải thật có thể lệch 30 phần trăm so với 25k khi thẳng, đó là lý do bạn nên đo dải của chính mình. Dải cũng đọc khác nhau tùy vào vị trí uốn cong dọc theo chiều dài và độ siết, chứ không chỉ góc, nên một khớp ngón tay và một đường cong nhẹ cùng góc sẽ cho số khác nhau.
Dải thật từ từ trở lại sau khi duỗi thẳng, nên số đọc mất một lúc mới ổn định, và nó đọc hơi cao hơn khi cũ đi. Hiệu chỉnh trên bàn tay hoặc bản lề nơi nó sẽ gắn, và kiểm tra lại sau vài tuần sử dụng.
Những lỗi thường gặp
Gập sai chiều. Gắn dải sao cho mặt in nằm ở phía ngoài của vết cong, nếu không dải thật gần như không thay đổi.
Gập ngay phần chân. Chỗ mối nối giữa chân và dải là điểm yếu; dán băng keo hoặc keo cố định đầu đó lại để nó không bao giờ bị cong.
Dùng 10k vì hướng dẫn FSR làm vậy. Với dải này nó chỉ chênh khoảng 200 đơn vị; hãy dùng 47k.
Bỏ quên constrain(). Dải bị gập thêm chút nữa so với lúc đo sẽ cho map() một số ngoài dải, và servo bị ra lệnh hơn 180 độ.
Chép FLAT và BENT của người khác. Hãy đo dải của chính bạn khi thẳng và khi gập, rồi dùng những số đó.
Mở mạch này trong trình soạn thảo. Arduino Uno: một cảm biến gập trên A0, được nối như ở đầu trang này. Thay đổi linh kiện hoặc giá trị rồi chạy lại.
Câu hỏi
Làm thế nào nối cảm biến gập vào Arduino?
Một chân vào 5 V, chân kia vào A0, và một điện trở 47k từ A0 xuống GND. Đọc bằng analogRead(A0): cao nhất khi thẳng, thấp dần khi cong.
Dùng điện trở nào với cảm biến uốn cong?
Giá trị gần với dải tự thân của cảm biến, 47k cho dải 2.2 inch đi từ 25k đến 100k. Ở đây nó cho chênh lệch 341 đơn vị, so với 199 với điện trở 10k.
Làm thế nào đổi số đọc của cảm biến uốn cong thành góc?
Đo số đọc khi thẳng và khi gập rồi dùng map() và constrain(). Muốn góc chính xác, trước hết tính điện trở từ mạch phân áp, rồi quy đổi ra độ.
Cảm biến uốn cong có hoạt động khi gập cả hai chiều không?
Không. Nó được thiết kế để cong một chiều, với mặt in ở phía ngoài. Gập ngược lại thì dải thật thay đổi rất ít.
Tiếp tục nào
Lắp mạch này ngoài đời
Mở trình soạn thảo, đổi một giá trị và xem con số thay đổi theo. Không cần cài gì, không cần tài khoản.