Lengan robot empat servo di PCA9685 servo driver
Mahir
Atau lihat semua pelajaran.
- 526komponen di meja kerja
- 46board sedang berjalan
- 1.00xwaktu nyata, di semua board
PCA9685 adalah board biru dengan enam belas header servo di sepanjang satu sisinya. Ia membuat pulsa servo sendiri, jadi Arduino-mu hanya perlu mengatakan ke mana setiap servo harus bergerak. Ia hanya butuh dua kabel dari board, pin I2C, baik kamu menjalankan satu servo maupun enam belas. Itulah sebabnya kit lengan robot dan hexapod memakainya.
Rangkaian di atas adalah Arduino Uno yang menggerakkan lengan robot meja empat servo lewat PCA9685. Lengan itu mengambil komponen di kiri, berayun menyeberang, meletakkannya di kanan lalu kembali ke posisi awal, berulang-ulang. Setiap gerakan ditampilkan di Serial Monitor. Ia berjalan di browser-mu dengan sketch di bawah.
Yang kamu butuhkan
- Arduino Uno
- Board servo driver PCA9685 16 kanal
- Up to sixteen hobby servos (four SG90s in a robot arm here)
- Catu daya 5 V terpisah untuk servo
- Kabel jumper
Pengkabelan
| Komponen dan pin | Disambung ke | Catatan |
|---|---|---|
| PCA9685 SDA | A4 | Data I2C milik Uno |
| PCA9685 SCL | A5 | Jam I2C milik Uno; board ini punya pull-up bawaannya sendiri |
| PCA9685 VCC | 5 V | Daya logika hanya untuk chip |
| PCA9685 GND | GND | Disambungkan bersama Uno dan catu daya servo |
| PCA9685 V+ | Catu daya 5 V terpisah | Daya untuk servo, bukan dari Uno |
| Channel 0 | Servo dasar | Memutar seluruh lengan |
| Channel 1 | Servo bahu | Memiringkan lengan atas |
| Channel 2 | Servo siku | Memiringkan lengan bawah |
| Channel 3 | Servo capit | Membuka dan menutup capit |
Dua catu daya, satu ground
PCA9685 punya dua catu daya terpisah. VCC memberi daya chip dan berasal dari pin 5 V Uno. V+ memberi daya servo dan sebaiknya berasal dari catu daya 5 V tersendiri. Servo menarik arus besar saat bergerak, jauh lebih besar dari yang seharusnya diberikan pin 5 V Uno. Semua ground disambungkan bersama.
Ini adalah penyebab masalah terbesar pada build sungguhan. Servo yang bergetar, atau Uno yang me-reset saat lengan bergerak, hampir selalu karena servo dijalankan dari 5 V board itu sendiri.
Kodenya: dari sudut ke pulsa
Sketch ini menggunakan library Adafruit PWM Servo Driver, yang sudah bawaan di Mokxi. pwm.begin() membangunkan chip. pwm.setPWMFreq(50) mengatur laju pulsa yang diharapkan servo: lima puluh kali per detik.
Lalu setAngle() mengubah sudut menjadi lebar pulsa. Sketch ini memakai jendela library Servo Arduino, 544 mikrodetik untuk 0 derajat dan 2400 mikrodetik untuk 180, jadi map() mengubah satu ke yang lain, dan writeMicroseconds() mengirimkannya ke satu channel.
glide() menggerakkan keempat sendi ke pose baru bersama-sama, dalam 25 langkah kecil dengan jarak 30 ms. Begitulah cara lengan sungguhan menghindari membenturkan girnya dan mengayun apa yang dibawanya.
#include <Wire.h>
#include <Adafruit_PWMServoDriver.h>
Adafruit_PWMServoDriver pwm = Adafruit_PWMServoDriver();
const int MIN_US = 544;
const int MAX_US = 2400;
void setAngle(int channel, int degrees) {
pwm.writeMicroseconds(channel, map(degrees, 0, 180, MIN_US, MAX_US));
}
void setup() {
Serial.begin(115200);
pwm.begin();
pwm.setPWMFreq(50);
setAngle(0, 90); // the base to the middle
}setPWM dan hitungan
Banyak tutorial memakai pwm.setPWM(channel, 0, count) alih-alih writeMicroseconds(). Chip membagi tiap periode menjadi 4096 hitungan. Pada 50 Hz, satu hitungan sekitar 4,9 mikrodetik, jadi pulsa servo 544 sampai 2400 mikrodetik sekitar 111 sampai 492 hitungan. Keduanya bisa dipakai di sini.
Baris osilator pada contoh Adafruit
Contoh sketch Adafruit menyertakan pwm.setOscillatorFrequency(27000000). Baris itu menyetel library untuk satu chip sungguhan tertentu, karena chip sungguhan berjalan beberapa persen dari 25 MHz nominalnya.
Chip simulasi berjalan tepat di 25 MHz. Salin baris itu ke Mokxi dan setiap pulsa keluar sekitar 8 persen lebih pendek dari yang kamu minta. Di sini, biarkan saja baris itu tidak dipakai. Di board-mu sendiri, ukur dan sesuaikan jika servomu sedikit meleset.
Coba di editor
Ubah sudut-sudut di loop untuk mengajari lengan gerakan baru. Ubah 25 langkah menjadi 50 di glide() dan setiap gerakan jadi lebih halus dan lebih lambat.
Bandingkan dengan proyek Robot arm with joysticks. Proyek itu menggerakkan lengan yang sama dari empat pin Uno dengan library Servo dan tanpa PCA9685. Empat servo tetap muat di Uno dengan cara apa pun; PCA9685-lah yang membuatmu bisa pakai enam belas servo hanya dengan dua kabel.
Amati PCA9685 saat berjalan. Di bawah tiap channel, board menampilkan lebar pulsa yang dikirimkan, dalam mikrodetik.
Kesalahan umum
Memberi daya servo dari pin 5 V Uno. Beri V+ catu daya tersendiri dan sambungkan ground-nya bersama.
Lupa setPWMFreq(50). Servo mengharapkan pulsa lima puluh kali per detik.
Batas pulsa yang tidak cocok dengan servomu. Servo berbeda-beda: ada yang ingin 1000 sampai 2000 mikrodetik, ada juga yang 500 sampai 2500. Cek servomu, lalu atur min_pulse dan max_pulse servo di sini agar cocok, kalau tidak kamu tidak akan mencapai rentang penuh.
Dua board di alamat yang sama. Setiap PCA9685 mulai di 0x40. Untuk menambah board lagi, solder jumper alamat di board tambahan agar masing-masing punya alamat sendiri.
Buka rangkaian ini di editor. Arduino Uno: lengan robot pada PCA9685, dirangkai seperti saat berjalan di bagian atas halaman ini. Ubah komponen atau nilai lalu jalankan lagi.
Buka rangkaian iniPertanyaan
Berapa banyak servo yang bisa dikendalikan PCA9685?
Enam belas per board. Board bisa berbagi dua kabel I2C yang sama jika masing-masing punya alamat sendiri, diatur dengan jumper solder.
Pin apa saja yang dipakai PCA9685 pada Arduino Uno?
SDA ke A4 dan SCL ke A5, plus 5 V dan ground untuk chip. Servo mendapat daya dari V+.
Kenapa servoku bergetar pada PCA9685?
Paling sering karena catu daya servo terlalu lemah atau dipakai bersama Arduino. Beri V+ catu daya 5 V tersendiri yang mampu menangani semua servo bergerak sekaligus.
Apa yang tidak dimodelkan Mokxi pada PCA9685?
Variasi osilator sungguhan, input clock eksternal, sub-alamat, dan panggilan reset perangkat lunak. Chip berjalan tepat di 25 MHz.
Lanjutkan
Rakit versi nyatanya
Buka editor, ubah sebuah nilai, dan lihat angkanya ikut berubah. Tidak ada yang perlu dipasang, dan tidak perlu akun.