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