quat_output = phase_correction(m_quat_driv, m_quat_aid);
- m_quaternion = quat_output;
+ m_quat_9axis = quat_output;
orientation = quat2euler(quat_output);
}
template <typename TYPE>
-quaternion<TYPE> orientation_filter<TYPE>::get_quaternion(const sensor_data<TYPE> accel,
+quaternion<TYPE> orientation_filter<TYPE>::get_9axis_quaternion(const sensor_data<TYPE> accel,
const sensor_data<TYPE> gyro, const sensor_data<TYPE> magnetic)
{
get_orientation(accel, gyro, magnetic);
- return m_quaternion;
+ return m_quat_9axis;
}
#endif //_ORIENTATION_FILTER_H_
quaternion<TYPE> m_quat_driv;
rotation_matrix<TYPE> m_rot_matrix;
euler_angles<TYPE> m_orientation;
- quaternion<TYPE> m_quaternion;
+ quaternion<TYPE> m_quat_9axis;
TYPE m_gyro_dt;
int m_pitch_phase_compensation;
const sensor_data<TYPE> gyro, const sensor_data<TYPE> magnetic);
rotation_matrix<TYPE> get_rotation_matrix(const sensor_data<TYPE> accel,
const sensor_data<TYPE> gyro, const sensor_data<TYPE> magnetic);
- quaternion<TYPE> get_quaternion(const sensor_data<TYPE> accel,
+ quaternion<TYPE> get_9axis_quaternion(const sensor_data<TYPE> accel,
const sensor_data<TYPE> gyro, const sensor_data<TYPE> magnetic);
};
return orien_filter.get_rotation_matrix(accel_data, gyro_data, magnetic_data);
}
-quaternion<float> orientation_sensor::get_quaternion(sensor_data<float> accel_data,
+quaternion<float> orientation_sensor::get_9axis_quaternion(sensor_data<float> accel_data,
sensor_data<float> gyro_data, sensor_data<float> magnetic_data)
{
pre_process_data(accel_data, accel_data, bias_accel, sign_accel, scale_accel);
orien_filter.m_azimuth_phase_compensation = azimuth_phase_compensation;
orien_filter.m_magnetic_alignment_factor = magnetic_alignment_factor;
- return orien_filter.get_quaternion(accel_data, gyro_data, magnetic_data);
+ return orien_filter.get_9axis_quaternion(accel_data, gyro_data, magnetic_data);
}
#endif
sensor_data<float> gyro, sensor_data<float> magnetic);
rotation_matrix<float> get_rotation_matrix(sensor_data<float> accel,
sensor_data<float> gyro, sensor_data<float> magnetic);
- quaternion<float> get_quaternion(sensor_data<float> accel,
+ quaternion<float> get_9axis_quaternion(sensor_data<float> accel,
sensor_data<float> gyro, sensor_data<float> magnetic);
};
unsigned long long time_stamp;
euler_angles<float> orientation;
rotation_matrix<float> orientation_mat;
- quaternion<float> orientation_quat;
+ quaternion<float> orientation_9axis_quat;
orientation_sensor orien_sensor1, orien_sensor2, orien_sensor3;
accel_in.open(((string)ORIENTATION_DATA_PATH + (string)"accel.txt").c_str());
cout << "Orientation matrix\t" << orientation_mat.m_rot_mat << "\n\n";
- orientation_quat = orien_sensor3.get_quaternion(accel_data, gyro_data, magnetic_data);
+ orientation_9axis_quat = orien_sensor3.get_9axis_quaternion(accel_data, gyro_data, magnetic_data);
- cout << "Orientation quaternion\t" << orientation_quat.m_quat << "\n\n";
+ cout << "Orientation 9-axis quaternion\t" << orientation_9axis_quat.m_quat << "\n\n";
}
accel_in.close();