Tự làm cảm biến góc giá rẻ, hiệu quả cho robot với Arduino và MPU6050

    Trong những năm gần đây, cảm biến góc xuất hiện rất nhiều trong cuộc thi robot, bởi ưu điểm xác định chính xác đường đi, không cần dò line cho robot.

    Trong những năm gần đây, cảm biến góc xuất hiện rất nhiều trong cuộc thi robot, bởi ưu điểm xác định chính xác đường đi, không cần dò line cho robot. Với giá thành khoảng 500K chúng ta có thể mua một cảm biến góc ( La bàn điện tử) để sử dụng, thế nhưng qua nghiên cứu và đã sử dụng, Eclub hướng dẫn các bạn tự làm một board cảm biến góc đơn giản chỉ với khoảng 200K, bằng Arduino promini+ MPU6050.

    Nguyên lý rất đơn giản, hẳn là các bạn đã biết Arduino là mã nguồn mở rất lớn, vì vậy không khó để chúng ta tìm được một Opensourse đọc tốt các giá trị của MPU6050.

    Mạch nguyên lý như sau:

    Phần xử lý chính là Arduino + MPU6050, LCD chỉ là phần phụ cho việc hiển thị từ ATmega128

    Phần này chính là phần xử lý tín hiệu chính cho MPU6050, chúng ta làm thế này có nhiều cái lợi, trong đó có việc giảm tải việc xử lý đọc tín hiệu MPU6050, phải dùng nhiều ngắt cùng lúc cho ATmega128. Dữ liệu được trả về thông quan UART nên rất thuận tiện cho các bạn đọc trên Chip chủ của mình, ở đây tôi dùng ATmega128.

    Thông số cơ bản cho giao tiếp:

    Arduino pro mini: Serial cứng (Tx,Rx), baud:9600

    ATmega128: UART1, Baud:9600, Communication Parameters: 8 Data, 2 Stop, No Parity

    Giá trị trả về từ 0-359 độ, sai số ( Trôi góc theo thời gian 3 phút khoảng 1-3 độ) .

    Toàn bộ code cho Arduino đọc MPU6050 trả về data cho ATmega128 các bạn down tại đây

    Code xử lý data của nhận từ Arduino chuyển sang giá trị góc 0-359 độ, down tại đây

    Video kết quả các bạn xem tại đây

    Eclub



    Các bài viết khác:


  • Hướng dẫn đấu nối và test mạch công suất PID
  • Hướng dẫn setup mạch công suất PID
  • Robocon2017- Thiết kế thành công module dò đường cho robot sử dụng ADC
  • Mạch điều khiển RiniRobocon2016
Coppy right ©: 2016 by Đỗ Ngọc Tuấn-TCU
Email: ngoctuansqtt@gmail.com