Servo-Sweep
Was dieses Beispiel zeigt
Ein Hobby-Servo wird per Winkel statt mit rohen Ticks angesteuert und über seinen konfigurierten Bereich hin- und hergefahren. Das ist der wichtigste beworbene Anwendungsfall des Boards.
Der Beispielcode
/**
**************************************************
*
* @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);
}
}
Stecken Sie den Servo vor dem Ausführen in den CH1-Header, der im Code Kanal 0 entspricht: das Signalkabel an OUT, das Stromkabel an V+ und das Massekabel an GND. Schließen Sie dann eine zu Ihrem Servo passende Spannungsversorgung an V+ und GND der Schraubklemme an, weil das Qwiic-Kabel keine Servoversorgung führt. Hardware-Details zeigt die Anschlüsse für die Servoversorgung.
Erwartetes Ergebnis:
Keine serielle Ausgabe. Ein an Kanal 0 angeschlossener Hobby-Servo fährt von 0 bis 180 Grad und zurück, wobei jede Richtung etwas weniger als 3 Sekunden dauert, und wiederholt das dann.
Verwendete Funktionen
PCA9685(uint8_t _address = PCA9685_DEFAULT_ADDRESS)returns NoneNativer Konstruktor. Die I2C-Adresse des Boards wird durch die Lötbrücken JP1-JP6 festgelegt. Übergeben Sie daher die Adresse, die zur Einstellung Ihres Boards passt, oder belassen Sie den Standardwert.
ReturnsKonstruktor; kein Rückgabewert.
Parameter
| Typ | Name | Beschreibung |
|---|---|---|
uint8_t | _address | I2C-Adresse des Boards. Standardmäßig PCA9685_DEFAULT_ADDRESS (0x40). |
begin()returns voidInitialisiert den PCA9685 über I2C und stellt die Standard-PWM-Frequenz von 50 Hz ein, die Hobby-Servos erwarten. Rufen Sie sie einmal in setup() auf.
ReturnsNichts.
setServoPulseRange(uint16_t minPulseUs, uint16_t maxPulseUs)returns voidLegt die Pulsbreite in Mikrosekunden fest, die setServoAngle() dem minimalen und dem maximalen Winkel zuordnet. Passen Sie sie an das Datenblatt Ihres Servos an, falls er mit dem Standardwert der Bibliothek seinen vollen mechanischen Bereich nicht erreicht.
ReturnsNichts.
Parameter
| Typ | Name | Beschreibung |
|---|---|---|
uint16_t | minPulseUs | Pulsbreite in Mikrosekunden, die dem minimalen Winkel zugeordnet wird. Standard der Bibliothek: 500 us. |
uint16_t | maxPulseUs | Pulsbreite in Mikrosekunden, die dem maximalen Winkel zugeordnet wird. Standard der Bibliothek: 2500 us. |
setServoAngleRange(float minAngle, float maxAngle)returns voidLegt den Winkelbereich in Grad fest, den setServoAngle() akzeptiert.
ReturnsNichts.
Parameter
| Typ | Name | Beschreibung |
|---|---|---|
float | minAngle | Winkel in Grad, der minPulseUs zugeordnet wird. Standard der Bibliothek: 0. |
float | maxAngle | Winkel in Grad, der maxPulseUs zugeordnet wird. Standard der Bibliothek: 180. |
setServoAngle(uint8_t channel, float angle)returns voidFährt einen Hobby-Servo am angegebenen Kanal auf einen Winkel, begrenzt auf den konfigurierten Winkelbereich. Rechnet den Winkel intern in eine Pulsbreite um und ruft setPWM() auf, wobei die 50 Hz vorausgesetzt werden, die begin() standardmäßig einstellt.
ReturnsNichts.
Parameter
| Typ | Name | Beschreibung |
|---|---|---|
uint8_t | channel | Kanalnummer, 0 bis 15. |
float | angle | Winkel in Grad, begrenzt auf den mit setServoAngleRange() festgelegten Bereich. |
Alles zusammen
setServoPulseRange() und setServoAngleRange() sind einmalige Setup-Aufrufe: Führen Sie
sie einmal aus, vor dem ersten setServoAngle(). Danach übernimmt setServoAngle()
die Umrechnung von Winkel in Pulsbreite und ruft setPWM() für Sie auf, sodass Sie für einen Servo nie
Tick-Werte von Hand berechnen müssen.
setServoAngle() setzt setPWMFreq(50) voraus, den Standard, den begin() setzt. Die
PWM-Frequenz gilt für alle 16 Kanäle gemeinsam: setPWMFreq() nimmt keinen Kanal entgegen,
daher ändert ein Aufruf für eine LED auch alle 16 Ausgänge, einschließlich
des Servosignals. Lassen Sie das Board auf 50 Hz, solange es Servos ansteuert.