Skip to main content

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​

Select Board
Servo_Sweep.ino
/**
**************************************************
*
* @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 None

Izvorni 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

TipNazivOpis
uint8_t_addressI2C adresa pločice. Zadana vrijednost je PCA9685_DEFAULT_ADDRESS (0x40).
begin()returns void

Inicijalizira 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 void

Konfigurira š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

TipNazivOpis
uint16_tminPulseUsŠirina impulsa u mikrosekundama koja odgovara minimalnom kutu. Zadana vrijednost biblioteke: 500 us.
uint16_tmaxPulseUsŠirina impulsa u mikrosekundama koja odgovara maksimalnom kutu. Zadana vrijednost biblioteke: 2500 us.
setServoAngleRange(float minAngle, float maxAngle)returns void

Konfigurira raspon kuta, u stupnjevima, koji prihvaća setServoAngle().

ReturnsNišta.

Parametri

TipNazivOpis
floatminAngleKut u stupnjevima koji odgovara vrijednosti minPulseUs. Zadana vrijednost biblioteke: 0.
floatmaxAngleKut u stupnjevima koji odgovara vrijednosti maxPulseUs. Zadana vrijednost biblioteke: 180.
setServoAngle(uint8_t channel, float angle)returns void

Pomič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

TipNazivOpis
uint8_tchannelBroj kanala, od 0 do 15.
floatangleKut 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.