Hi
So hab ich das mal gemacht:
Code:void setServoPos(uint8_t servo, uint16_t stellung) { twiStart(); twiWriteByte(0xC2, 0); twiWriteByte((servo-1)*3+1, 0); twiWriteByte((unsigned char)(stellung & 0xFF), 0); twiWriteByte((unsigned char)(stellung >> 8), 0); twiStop(); } void setServoSpeed(uint8_t servo, uint8_t speed) { twiStart(); twiWriteByte(0xC2, 0); twiWriteByte((servo-1)*3, 0); twiWriteByte(speed, 0); twiStop(); }
Lesezeichen