made the servo move, but still not correct