Học

Cách dùng cảm biến gập với một Arduino

Bắt đầu làm miễn phí

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
Arduino Uno: một cảm biến gập trên A0trực tiếp0.000 s 0.00x
Nhấp để mở trong trình soạn thảo
Một cảm biến gập từ 5 V vào A0 và một điện trở 47k từ A0 xuống GND, trên ATmega328P được mô phỏng. Kéo thanh trượt để gập dải cảm biến.

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ânNối tớiGhi chú
Cảm biến gập, một chân bất kỳ5 VNó 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ạiA0
Điện trở 47kTừ A0 sang GNDTạo thành mạch phân áp
Tín hiệu servoChân 9Cho 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.

Độ bằng map()
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.

Độ tính từ ohm
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.

Một ngón tay bằng servo
#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.

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.