Kompas Servo yang Sangat Dasar dan Tidak Dikalibrasi: 7 Langkah

2024 Pengarang: John Day | [email protected]. Terakhir diubah: 2024-01-30 09:55

Ini hanyalah instruksi dasar untuk proyek yang sedang saya kerjakan. Ini tidak dikalibrasi dan merupakan prototipe yang sangat dasar yang dibuat untuk kelas. Dalam instruksi selanjutnya, saya akan menunjukkan cara mengkalibrasinya.

Saya tidak akan berharap banyak kehebatan dari ini jika saya jadi Anda, ini lebih mendokumentasikan prosesnya.

Perlengkapan

• Micro servo (saya menggunakan HXT900 Micro Servo dari Hobby King)
• Arduino (saya menggunakan Uno)
• LSM303DLHC adalah sensornya
• Kabel, solder, dll
• Papan tempat memotong roti

Langkah 1: Kumpulkan Semuanya

Pastikan header Anda disolder ke sensor Anda dengan benar dan Anda memiliki kabel dan papan tempat memotong roti.

Langkah 2: Perpustakaan Kode

Anda akan ingin memastikan bahwa Anda telah mengunduh ini.

Pustaka lain yang akan Anda gunakan, wire.h dan servo.h, seharusnya sudah terinstal secara default.

Langkah 3: Kode

Buka perpustakaan sketsa 'Kompas' dari apa yang baru saja Anda unduh. Untuk menggunakan servo, Anda ingin memasukkan kode servo ke dalam kode ini. Saya menggabungkannya dengan kode Hanie Kiana dari sini. Yang asli oleh Hanie Kiani, bukan saya. Seharusnya terlihat seperti ini.

#termasuk

#include #include #include #include Adafruit_LSM303DLH_Mag_Unified mag = Adafruit_LSM303DLH_Mag_Unified(12345); int servoPin = 3; Servo Servo1; void setup(void) { Serial.begin(9600); Kawat.mulai(); Servo1.attach(servoPin); Serial.println("Uji Magnetometer"); Serial.println(""); if (!mag.begin()) { Serial.println("Ooops, LSM303 tidak terdeteksi … Periksa kabel Anda!"); sedangkan (1); } } void loop(void) { /* Dapatkan event sensor baru */sensors_event_t event; mag.getEvent(&acara); float Pi = 3,14159; // Hitung sudut dari vektor y, x float heading = (atan2(event.magnetic.y, event.magnetic.x) * 180) / Pi; // Normalisasi ke 0-360 if (heading < 0) { heading = 360 + heading; } Serial.print("Judul Kompas: "); Serial.println(judul); Servo1.write(180-judul); penundaan (10); }

Langkah 4: Hubungkan Bersama

Anda ingin pin paling kiri- SCL- terhubung ke input data A5

Yang di sebelahnya- SDA- terhubung ke port A4.

Tanah pergi ke Tanah.

VIN masuk ke port 5v.

Langkah 5: Tambahkan Servo ke Pengkabelan

Ground dan voltase berbicara sendiri, tetapi Anda ingin pin data menjadi ~3.

Langkah 6: Uji Kode

Jika Anda menggerakkan magnetometer secara perlahan, servo harus bergerak bersamanya. Kemungkinan tidak bervariasi akurat, tetapi setidaknya bekerja dengan kode, jadi bagian pertama selesai. Ini masih belum dikalibrasi, tetapi berfungsi.