• Home
  • Raw
  • Download

Lines Matching refs:rotMatrix

287     float rotMatrix[9];  in inv_get_euler_angles_x()  local
296 result = inv_get_rot_mat_float(rotMatrix); in inv_get_euler_angles_x()
297 tmp = rotMatrix[6]; in inv_get_euler_angles_x()
306 (atan2f(rotMatrix[7], rotMatrix[8]) * 57.29577951308) * in inv_get_euler_angles_x()
311 (atan2f(rotMatrix[3], rotMatrix[0]) * 57.29577951308) * in inv_get_euler_angles_x()
345 float rotMatrix[9]; in inv_get_euler_angles_y() local
354 result = inv_get_rot_mat_float(rotMatrix); in inv_get_euler_angles_y()
355 tmp = rotMatrix[7]; in inv_get_euler_angles_y()
364 (atan2f(rotMatrix[8], rotMatrix[6]) * 57.29577951308f) * in inv_get_euler_angles_y()
369 (atan2f(rotMatrix[4], rotMatrix[1]) * 57.29577951308f) * in inv_get_euler_angles_y()
403 float rotMatrix[9]; in inv_get_euler_angles_z() local
412 result = inv_get_rot_mat_float(rotMatrix); in inv_get_euler_angles_z()
413 tmp = rotMatrix[8]; in inv_get_euler_angles_z()
422 (atan2f(rotMatrix[6], rotMatrix[7]) * 57.29577951308) * in inv_get_euler_angles_z()
427 (atan2f(rotMatrix[5], rotMatrix[2]) * 57.29577951308) * in inv_get_euler_angles_z()
705 float rotMatrix[9]; in inv_get_heading() local
713 result = inv_get_rot_mat_float(rotMatrix); in inv_get_heading()
714 if ((rotMatrix[7] < 0.707) && (rotMatrix[7] > -0.707)) { in inv_get_heading()
716 (float)(atan2f(rotMatrix[4], rotMatrix[1]) * 57.29577951308 - in inv_get_heading()
720 (float)(atan2f(rotMatrix[5], rotMatrix[2]) * 57.29577951308 + in inv_get_heading()
1630 float rotMatrix[9]; in inv_get_euler_angles_x_float() local
1640 result = inv_get_rot_mat_float(rotMatrix); in inv_get_euler_angles_x_float()
1641 tmp = rotMatrix[6]; in inv_get_euler_angles_x_float()
1649 (float)(atan2f(rotMatrix[7], in inv_get_euler_angles_x_float()
1650 rotMatrix[8]) * 57.29577951308); in inv_get_euler_angles_x_float()
1653 (float)(atan2f(rotMatrix[3], rotMatrix[0]) * 57.29577951308); in inv_get_euler_angles_x_float()
1705 float rotMatrix[9]; in inv_get_euler_angles_y_float() local
1715 result = inv_get_rot_mat_float(rotMatrix); in inv_get_euler_angles_y_float()
1716 tmp = rotMatrix[7]; in inv_get_euler_angles_y_float()
1724 (float)(atan2f(rotMatrix[8], rotMatrix[6]) * 57.29577951308); in inv_get_euler_angles_y_float()
1727 (float)(atan2f(rotMatrix[4], rotMatrix[1]) * 57.29577951308); in inv_get_euler_angles_y_float()
1767 float rotMatrix[9]; in inv_get_euler_angles_z_float() local
1777 result = inv_get_rot_mat_float(rotMatrix); in inv_get_euler_angles_z_float()
1778 tmp = rotMatrix[8]; in inv_get_euler_angles_z_float()
1786 (float)(atan2f(rotMatrix[6], rotMatrix[7]) * 57.29577951308); in inv_get_euler_angles_z_float()
1789 (float)(atan2f(rotMatrix[5], rotMatrix[2]) * 57.29577951308); in inv_get_euler_angles_z_float()
1918 float rotMatrix[9]; in inv_get_heading_float() local
1928 inv_get_rot_mat_float(rotMatrix); in inv_get_heading_float()
1929 if ((rotMatrix[7] < 0.707) && (rotMatrix[7] > -0.707)) { in inv_get_heading_float()
1931 (float)(atan2f(rotMatrix[4], rotMatrix[1]) * 57.29577951308 - in inv_get_heading_float()
1935 (float)(atan2f(rotMatrix[5], rotMatrix[2]) * 57.29577951308 + in inv_get_heading_float()