Servomotoren steuern / Greifer bauen
Hallo,
ich habe einen VSD-1 Servomotor von Modelcraft gekauft und an meinen RP6 über einen I2C I/O Expander angeschlossen. Mit diesem Code, der innerhalb einer Endlosschleife läuft, aktiviere und deaktiviere ich eine 5 Volt Spannung die als Steuersignal beim Servomotor ankommt.
Code:
if (firstRun == 0){
I2CTWI_transmitByte(PCF8574_8LEDS_ADR, (0b00000000) );
firstRun = 1;
}
uint8_t bumper_left = getBumperLeft();
uint8_t bumper_right = getBumperRight();
if (bumper_left) {
if(flipLeft == 0){
flipLeft = 1;
I2CTWI_transmitByte(PCF8574_8LEDS_ADR, (0b00000000) );
}
else {
flipLeft = 0;
I2CTWI_transmitByte(PCF8574_8LEDS_ADR, (0b11111111) );
}
}
if (bumper_right) {
I2CTWI_transmitByte(PCF8574_8LEDS_ADR, (0b00000000) );
}
mSleep(50);
Der RP6 hat vorne zwei Bumper die ich als Steuerknöpfe missbrauche.
Halte ich den linken Bumper gedrückt und drücke dann den rechten Bumper erreiche ich eine Winkelveränderung von 20 Grad auf ca. 160 Grad. Lasse ich den rechten Bumper wieder los dreht sich der Servo zurück auf 20 Grad. Ab und zu "zittert" der Motor hörbar.
Wie würde ein setzeWinkel(Winkel) Befehl aussehen?
Kennt ihr Bauanleitungen (mit Einkaufslisten) für Greifer?
