rewrite MoveIntakeArmToAngle to calculate speed based error