Zum Hauptinhalt springen

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​

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);
}
}

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 None

Nativer 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

TypNameBeschreibung
uint8_t_addressI2C-Adresse des Boards. Standardmäßig PCA9685_DEFAULT_ADDRESS (0x40).
begin()returns void

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

Legt 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

TypNameBeschreibung
uint16_tminPulseUsPulsbreite in Mikrosekunden, die dem minimalen Winkel zugeordnet wird. Standard der Bibliothek: 500 us.
uint16_tmaxPulseUsPulsbreite in Mikrosekunden, die dem maximalen Winkel zugeordnet wird. Standard der Bibliothek: 2500 us.
setServoAngleRange(float minAngle, float maxAngle)returns void

Legt den Winkelbereich in Grad fest, den setServoAngle() akzeptiert.

ReturnsNichts.

Parameter

TypNameBeschreibung
floatminAngleWinkel in Grad, der minPulseUs zugeordnet wird. Standard der Bibliothek: 0.
floatmaxAngleWinkel in Grad, der maxPulseUs zugeordnet wird. Standard der Bibliothek: 180.
setServoAngle(uint8_t channel, float angle)returns void

Fä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

TypNameBeschreibung
uint8_tchannelKanalnummer, 0 bis 15.
floatangleWinkel 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.