Pomicanje servomotora
Što ovaj primjer prikazuje
Upravljanje hobi servomotorom pomoću kuta umjesto sirovih otkucaja (ticks) te njegovo pomicanje naprijed-natrag preko konfiguriranog raspona. Ovo je glavna namjena pločice.
Kod primjera
/**
**************************************************
*
* @file Servo_Sweep.ino
* @brief Sweep a hobby servo on channel 0 back and forth using PCA9685.
*
* @authors @ soldered.com
***************************************************/
#include "PCA9685-SOLDERED.h"
PCA9685 pwm;
void setup()
{
pwm.begin(); // sets 50Hz PWM frequency by default, suitable for hobby servos
// Adjust to match your servo's datasheet if it doesn't reach full range
pwm.setServoPulseRange(500, 2500); // microseconds
pwm.setServoAngleRange(0, 180); // degrees
}
void loop()
{
for (int angle = 0; angle <= 180; angle += 1)
{
pwm.setServoAngle(0, angle);
delay(15);
}
for (int angle = 180; angle >= 0; angle -= 1)
{
pwm.setServoAngle(0, angle);
delay(15);
}
}
Prije pokretanja priključite servomotor na CH1 header, koji je u kodu kanal 0: njegovu signalnu žicu na OUT, žicu napajanja na V+, a žicu mase na GND. Zatim na V+ i GND vijčanog priključka spojite napajanje prikladno za vaš servomotor, jer Qwiic kabel ne prenosi snagu za servomotor. Hardverski detalji prikazuju spojeve napajanja servomotora.
Očekivani rezultat:
Nema serijskog ispisa. Hobi servomotor spojen na kanal 0 pomiče se od 0 do 180 stupnjeva i natrag, pri čemu svaki smjer traje nešto manje od 3 sekunde, a zatim se ponavlja.
Korištene funkcije
PCA9685(uint8_t _address = PCA9685_DEFAULT_ADDRESS)returns NoneIzvorni konstruktor. I2C adresa pločice određena je lemnim jumperima JP1-JP6, stoga proslijedite adresu koja odgovara postavkama vaše pločice ili ostavite zadanu.
ReturnsKonstruktor; nema povratne vrijednosti.
Parametri
| Tip | Naziv | Opis |
|---|---|---|
uint8_t | _address | I2C adresa pločice. Zadana vrijednost je PCA9685_DEFAULT_ADDRESS (0x40). |
begin()returns voidInicijalizira PCA9685 preko I2C-a i postavlja zadanu PWM frekvenciju od 50 Hz, koju očekuju hobi servomotori. Pozovite je jednom u setup().
ReturnsNišta.
setServoPulseRange(uint16_t minPulseUs, uint16_t maxPulseUs)returns voidKonfigurira širinu impulsa, u mikrosekundama, koju setServoAngle() pridružuje minimalnom i maksimalnom kutu. Prilagodite je tehničkom listu svog servomotora ako pri zadanoj vrijednosti biblioteke ne dosegne puni mehanički raspon.
ReturnsNišta.
Parametri
| Tip | Naziv | Opis |
|---|---|---|
uint16_t | minPulseUs | Širina impulsa u mikrosekundama koja odgovara minimalnom kutu. Zadana vrijednost biblioteke: 500 us. |
uint16_t | maxPulseUs | Širina impulsa u mikrosekundama koja odgovara maksimalnom kutu. Zadana vrijednost biblioteke: 2500 us. |
setServoAngleRange(float minAngle, float maxAngle)returns voidKonfigurira raspon kuta, u stupnjevima, koji prihvaća setServoAngle().
ReturnsNišta.
Parametri
| Tip | Naziv | Opis |
|---|---|---|
float | minAngle | Kut u stupnjevima koji odgovara vrijednosti minPulseUs. Zadana vrijednost biblioteke: 0. |
float | maxAngle | Kut u stupnjevima koji odgovara vrijednosti maxPulseUs. Zadana vrijednost biblioteke: 180. |
setServoAngle(uint8_t channel, float angle)returns voidPomiče hobi servomotor na zadanom kanalu na određeni kut, ograničen na konfigurirani raspon kuta. Interno pretvara kut u širinu impulsa i poziva setPWM(), uz pretpostavku frekvencije od 50 Hz koju begin() postavlja prema zadanim postavkama.
ReturnsNišta.
Parametri
| Tip | Naziv | Opis |
|---|---|---|
uint8_t | channel | Broj kanala, od 0 do 15. |
float | angle | Kut u stupnjevima, ograničen na raspon postavljen funkcijom setServoAngleRange(). |
Sve zajedno
setServoPulseRange() i setServoAngleRange() jednokratni su pozivi za postavljanje: pokrenite
ih jednom, prije prvog setServoAngle(). Nakon toga setServoAngle()
sam izračunava pretvorbu kuta u širinu impulsa i poziva setPWM() umjesto vas, pa za servomotor
nikada ne morate ručno računati broj otkucaja.
setServoAngle() pretpostavlja setPWMFreq(50), zadanu vrijednost koju postavlja begin(). PWM
frekvencija zajednička je za svih 16 kanala: setPWMFreq() ne prima kanal,
pa poziv učinjen za LED diodu mijenja i svih 16 izlaza, uključujući signal servomotora.
Dok pločica upravlja servomotorima, ostavite je na 50 Hz.