Fixes faulty degree / radian usages and coordinate system mix-ups in test_bathing_env.py.
Test Plan:
Tests may fail since it seems like the robot is not actually behaving as expected in #109. At least, test_angle_functions.py should certainly pass. Besides that, code review is needed to ensure the test cases are actually testing correct behavior.
Description:
Fixes faulty degree / radian usages and coordinate system mix-ups in
test_bathing_env.py.Test Plan:
Tests may fail since it seems like the robot is not actually behaving as expected in #109. At least,
test_angle_functions.pyshould certainly pass. Besides that, code review is needed to ensure the test cases are actually testing correct behavior.