Buat Pembuat Peta Ultrasonik dengan Arduino Yun – Panduan Langkah demi Langkah
Komponen dan Perlengkapan
Arduino Yun
×
1
Sensor Ultrasonik
×
1
Servos (Tower Pro MG996R)
×
1
Kabel Jumper (generik)
×
10
Aplikasi dan Layanan Online
Arduino IDE
MATLAB
Tentang Proyek Ini
Langkah 1: Teori
Dalam proyek ini, kita menggunakan sensor jarak ultrasonik. Ini menghasilkan gelombang suara di luar jangkauan pendengaran manusia dan mengukur jarak dengan menghitung waktu yang dibutuhkan oleh gelombang ini untuk mengenai halangan dan kembali. Ini mirip dengan prinsip yang digunakan oleh murciélago dan kapal kruis.
Komponen lain yang akan kita gunakan adalah motor servo. Ini berbeda dari motor DC biasa karena dapat berputar sangat tepat ke posisi sudut yang ditentukan dan mempertahankannya di sana. Ketika motor servo diberikan pulsa dengan durasi tertentu, ia bergerak ke posisi sudut yang sesuai.
Kita akan menggunakan kedua komponen ini untuk mendapatkan bidang pandang 180 derajat untuk robot kita.
Langkah 2: Mengumpulkan Bahan
Proyek ini menggunakan perangkat keras berikut:
Arduino Uno/Yun (Harap dicatat bahwa papan Arduino footprint apa pun dapat digunakan sebagai pengganti Uno atau Yun)
Arduino Prototyping Shield
Sensor Ultrasonik HC-04
Motor servo (Saya menggunakan Tower Pro SG90 karena sangat kompakt)
Di sisi perangkat lunak, kita menggunakan program berikut
Arduino IDE untuk mengunggah kode kontrol ke Arduino untuk memutar servo dan mendapatkan data jarak dari sensor ultrasonik serta mendorongnya ke port serial.
Mathworks MatLab untuk menerima data dari baris serial, memprosesnya, dan memvisualisasikannya ke dalam grafik.
Langkah 3: Rangkaian Mekanis
Menggunakan potongan PCB tujuan umum, buat header kecil untuk HC-04, dan pasang ke servo horn menggunakan potongan tipe double sided tape.
Langkah ini opsional, tetapi untuk membuat sistem lebih kompak, saya telah memasang servo pada bagian yang meluber dari papan shield protoboard menggunakan double sided tape juga.
Hasil akhir seharusnya terlihat seperti perut Wall-E.
Langkah 4: Kode Arduino
Kode Arduino mengontrol gerakan motor servo, dan saat pembacaan dari sensor ultrasonik ditangkap dan seberapa sering. Ini juga mendorong data sensor ke port serial.
Impor library
Inisialisasi variabel dan pin.
Inisialisasi objek servo
Inisialisasi komunikasi serial
Tunggu 3 detik
Inisialisasi counter ke 0
Putar servo 1 derajat
Dapatkan data sensor ultrasonik 10 kali (default)
Rata-ratakan data
Kirim rata-rata ke port serial
Kembali ke langkah 7
Langkah 5: Kode MatLab
Kode MatLab lebih berurusan dengan data daripada kontrol sebenarnya papan, jadi semua data sensor didorong melalui serial ke PC, tempat dibaca oleh MatLab.
Sekarang, data yang kita terima dari Arduino memberi kita dua hal. Derajat rotasi servo dan jarak halangan di arah tersebut. Oleh karena itu, data yang kita miliki saat ini adalah dalam sistem koordinat Polar. Untuk dapat dipahami oleh mata manusia saat divisualisasikan, harus dikonversi ke sistem koordinat Cartesian atau X-Y.
Jadi kode MatLab melakukan hal ini. Ini mendapatkan data secara serial dari port COM, menyimpannya ke dalam matriks dengan sudut rotasi, dan kemudian mengonversinya ke koordinat Cartesian dengan rumus yang diberikan di atas.
Setelah selesai, ini memberikan output dengan memplot titik-titik pada grafik. Saya meletakkan papan dalam kotak, dan saya mendapatkan hasil berikut.
Langkah 6: Kesimpulan
Meski sistem ini tidak sempurna, ini menyelesaikan pekerjaan. Ini dapat mendapatkan estimasi kasar lebar dan panjang kotak dan mengirim data secara akurat.
Hanya kesalahan yang saya lihat saat ini adalah karena getaran sensor saat servo bergerak dan pembacaan yang salah dari sensor itu sendiri.
Selain ini, sistem ini berjalan dengan baik dan dapat digunakan untuk eksperimen persepsi kedalaman serta proyek visi komputer dasar.
Kode
matlab_code_to_run_on_pc.m
Kode Arduino
matlab_code_to_run_on_pc.mMATLAB
Kode MatLab untuk dikompilasi dan dieksekusi pada PC
theta = 0:(pi/180):pi; s = serial('COM10'); s.BaudRate=9600 fopen(s) i = 0; inc = 1; while i<180 A = fgets(s); num(i+1) = str2num(A); i = i+1; end fclose(s) j = 1 while j<181 tab(j,1) = (j-1)*inc tab(j,2) = num(j) tab(j,3) = num(j)*cosd((j-1)*inc) tab(j,4) = num(j)*sind((j-1)*inc) j = j+1 end %figure %polar(theta,num) plot(tab(:,3),tab(:,4))
Kode ArduinoArduino
Kode Arduino untuk diunggah ke Arduino Yun
#include <Servo.h> #include <NewPing.h> #define TRIGGER_PIN 12 #define ECHO_PIN 11 #define MAX_DISTANCE 200 NewPing sonar(TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE); Servo myservo; int pos = 0; int it = 10; void setup() { myservo.attach(9); Serial.begin(9600); delay(3000); } void loop() { int i = 0; int t = 0; int a = 0; for (i = 0; i < 180; i ++) { unsigned int uS = sonar.ping(); myservo.write(i); delay(20); for (t = 0; t < it; t++) { uS = sonar.ping(); a = uS/US_ROUNDTRIP_CM + a; delay(30); } a = a / (it-1); t = 0; Serial.println(a); a = 0; } }
Skematik
File Fritzing untuk koneksi servo dan sensor ultrasonikYunConfig.fzz