Tested DroidCore Algorithm with additional speed control for each servo.