def speed_test(robot: MelfaRobot, speed: float) -> None:
start = Coordinate([-150, -150, 400, 180, 0, 0], robot.AXES) # pragma: no mutate
vector = Coordinate([200, 300, -350, 0, 0, 0], robot.AXES) # pragma: no mutate
finish = start + vector # pragma: no mutate
# Back to start
robot.protocol.reset_linear_speed()
robot.linear_move_poll(start)
# Test distance
start_time = time.clock()
t, v = robot.linear_move_poll(finish, speed * 60, track_speed=True)
finish_time = time.clock()
# Average velocity
velocity = vector.vector_len() / (finish_time - start_time)
# Draw speed
draw_speed(speed, t, v)
print("Velocity is: " + str(velocity))
def test_vector_len_none(self):
a = Coordinate([3, 2, None], "XYZ")
with pytest.raises(TypeError):
a.vector_len()
def test_vector_len(self, axes, values, expected):
a = Coordinate(values, axes)
assert a.vector_len() == pytest.approx(expected, abs=0.01)
