Stap 7: Functies beheersen de regels 8 servo
initialiseert de PCA9685 servo motor controller op macht omhoog. De periode register wordt geïnitialiseerd als een waarde, die in een periode van de PWM uitvoer van 20 milliseconden resulteert. Deze periode 20 milliseconden nodig is, dit is de tijd waarin de variabele breedte-signaal heeft zich te herhalen.
SetServoConstants (draai, begin, einde)
Deze functie wordt gebruikt om op te slaan sommige waarden welk annuleerteken wisseling van servo naar servo. Maximaal zetten hoek, kortste impuls, langste impuls. Deze parameters zijn nodig als we willen graag een servo schacht tot een gewenste hoek.
functie SERVO_command (id, hoek);
De functie die vertelt de I2C-apparaat om te beginnen met het geven van impulsen met gegeven tijdsinstellingen. De eerste parameter is het nummer van de servo-uitgang, de tweede is de hoek die wij willen de as van de servo inschakelen dat kanaal.
Deze drie zijn de functies die ik gebruikte toen het ging om de servomotoren besturen.