Belajar

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
Arduino Uno: lengan robot di PCA9685live0.000 s 0.00x
Klik untuk membukanya di editor
Contoh lengan pick and place di ATmega328P simulasi: empat servo, dua kabel I2C.

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 pinDisambung keCatatan
PCA9685 SDAA4Data I2C milik Uno
PCA9685 SCLA5Jam I2C milik Uno; board ini punya pull-up bawaannya sendiri
PCA9685 VCC5 VDaya logika hanya untuk chip
PCA9685 GNDGNDDisambungkan bersama Uno dan catu daya servo
PCA9685 V+Catu daya 5 V terpisahDaya untuk servo, bukan dari Uno
Channel 0Servo dasarMemutar seluruh lengan
Channel 1Servo bahuMemiringkan lengan atas
Channel 2Servo sikuMemiringkan lengan bawah
Channel 3Servo capitMembuka 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.

Setup dan satu sendi, dari contoh Pick and place arm
#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 ini

Pertanyaan

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.

Rakit versi nyatanya

Buka editor, ubah sebuah nilai, dan lihat angkanya ikut berubah. Tidak ada yang perlu dipasang, dan tidak perlu akun.