(self, roll, pitch, yaw)
| 298 | print("Command output:\n", stdout) |
| 299 | |
| 300 | def transform_euler_to_new_frame(self, roll, pitch, yaw): |
| 301 | R = euler_to_rotation_matrix(roll, pitch, yaw) |
| 302 | transformation_matrix = np.array([ |
| 303 | [0, -1, 0], |
| 304 | [1, 0, 0], |
| 305 | [0, 0, -1] |
| 306 | ]) |
| 307 | new_R = np.dot(transformation_matrix, R) |
| 308 | new_roll, new_pitch, new_yaw = rotation_matrix_to_euler_angles(new_R) |
| 309 | return new_roll, new_pitch, new_yaw |
| 310 | |
| 311 | def rotation_matrix_roll(self, roll): |
| 312 | return np.array([ |
nothing calls this directly
no test coverage detected