Code robot tránh vật cản

Trong chuỗi nội dung bài viết DIY chúng ta đang có tác dụng thân quen với những áp dụng đầy tính sáng chế như: Robot rời đồ dùng cản, khối hệ thống tưới cây auto, khối hệ thống tự động đếm fan ra vào…Sẽ hỗ trợ cho đọc đưa phát âm hơn về ngôn từ lập trình Arduino, là nền tảng gốc rễ hỗ trợ cộng đồng cùng mọi người trong nhà cải tiến và phát triển.

Bạn đang xem: Code robot tránh vật cản


Các linh kiện quan trọng để làm Robot tách đồ vật cản

Tên linch kiệnLink đặt mua
Khung Robothttps://macerafilmizle.com/khung-xe-robot
Mạch Arduino UNOhttps://macerafilmizle.com/arduino-uno-r3-ch340-cap-nap
Motor Shieldhttps://macerafilmizle.com/arduino-motor-shield-l293d
SG90 Servohttps://macerafilmizle.com/dong-co-rc-servo-sg90
Cảm trở nên tránh đồ vật cảnhttps://macerafilmizle.com/cam-bien-sieu-am-hc-sr04
Công tắchttp://bit.ly/Switch10PCS(Được tặng ngay kèm lúc mua full )
Tụ 100nFhttps://educ8s.tv/part/CeramicCapacitors(Được khuyến mãi ngay kèm khi mua full )
Tụ 300uFhttps://educ8s.tv/part/ElectrolyticCapacitors(Được bộ quà tặng kèm theo kèm khi mua full )
Dây nốihttps://educ8s.tv/part/Wires(Được khuyến mãi kèm lúc mua toàn bộ )

Lắp ráp Robot tách đồ dùng cản

Hàn thêm tụ 100nF vào đầu của hộp động cơ.

*
*
*
*
Sơ vật đấu nối Robot tách thiết bị cản

Đấu nối

Đấu nối cảm biến tách đồ vật cản vào Shield Motor

VCC5V
GNDGND
TRIGA4
ECHOA5

Đấu nối Servo vào Shield Motor

Dây bộc lộ (color vàng)S
VCC (Màu đỏ)+
GND (Màu đen)

Giải ham mê Code

Để lịch trình hoạt động và không báo lỗi khi nạp lịch trình. Bước trước tiên bọn họ yêu cầu thiết lập thỏng viện cùng Add tlỗi viện vào Arduino IDE.

Thêm thư viện bên trên Arduino IDE:https://macerafilmizle.com/huong-dan-them-moi-thu-vien-trong-arduino-ide


Tlỗi viện Motor Shield:https://github.com/adafruit/Adafruit-Motor-Shield-library

Thư viện NewPing:https://bitbucket.org/teckel12/arduino-new-ping/wiki/Home#!download-install

////////////////////////////////////////////// // Arduino ROBOT v0.1 // // //// http://www.educ8s.tv ///////////////////////////////////////////////#include #include #include Tiếp theo, bọn họ knhị báo chân kết nối mang lại cảm ứng tách đồ vật cản cùng hiệu chỉnh tốc độ của bộ động cơ, những chúng ta có thể biến hóa thông số kỹ thuật vận tốc động cơđến255.

Xem thêm: Tổng Hợp 12+ Mẫu Khay Trà Gỗ Chuyên Dùng, Khay Trà Gỗ Chuyên Dùng

#define TRIG_PIN A4 #define ECHO_PIN A5 #define MAX_DISTANCE 200 #define MAX_SPEED 190 // sets tốc độ of DC motors#define MAX_SPEED_OFFSET 20Knhị báo biến đổi đến hàm Servo với khởi sinh sản liên kết động cơ bên trên thỏng viện AFMotor.

AF_DCMotor motor1(1, MOTOR12_1KHZ); AF_DCMotor motor2(3, MOTOR12_1KHZ);Servo myservo; Tiếp theo trong hàm setup(), bọn họ knhì báo kết nối cho chân servo, ở chỗ này bọn họ kết nối servo vào chân 9 của board mạch, góc xoay servo đặt là 115 độ. Các bạn có thể tự xem sét ra góc tảo phù hợp đến robot rời vật cản của chính bản thân mình.

Xem thêm: Quả Cầu Thủy Tinh Phong Thủy Tinh Trên Bàn Làm Việc, Qủa Cầu Phong Thủy Treo Thủy Tinh Vát Cạnh

void setup() myservo.attach(9); myservo.write(115); delay(2000); distance = readPing(); delay(100); distance = readPing(); delay(100); distance = readPing(); delay(100); distance = readPing(); delay(100);Trong hàm loop() chuyển các cực hiếm đo về 0 và triển khai công tác sau 40ms. Nếu khoảng cách cảm ứng đo được nhỏ hơn hoặc bằng 15centimet thì Robot rời thiết bị cản vẫn dừng lại trong tầm thời hạn 100ms và lùi lại phía sau 300ms, tạm dừng vào 200ms. Robot quay đầu quan sát sang trọng trái, sang trọng đề nghị với đo khoảng cách. Nếu khoảng cách đo mặt nào lớn hơn hoặc bằng thì robot vẫn quay về hướng lớn nhất và dịch chuyển về vùng phía đằng trước. 

void loop() int distanceR = 0; int distanceL = 0; delay(40); if(distance=distanceL) turnRight(); moveStop(); else turnLeft(); moveStop(); else moveForward(); distance = readPing();}Tải Code

Cảm ơn các bạn sẽ đọc với theo dõi và quan sát macerafilmizle.com, trong quy trình thực hiện gồm gì thắc mắc các bạnbình luận bên dưới sẽ được mình cung ứng cực tốt. Nếu thấy nội dung bài viết tuyệt cùng hữu ích thìchớ ngần ngại cho doanh nghiệp 1 LikeShare bài viết bỏ không ít tín đồ cùng tsay đắm gia sản xuất.


Chuyên mục: Tổng Hợp