Skip to content

Rotation handling for roll/pitch/azimuth #12

Description

@prclibo

Hi! Just curious if this repo is still under maintenance?

I noticed that novatel_node.cpp uses tf::createQuaternionMsgFromRollPitchYaw to handle attitude angle roll/pitch/azimuth. tf::createQuaternionMsgFromRollPitchYaw assumes roll is around x and pitch around y. However, according to novatel manuals, in e.g. the PVA log, roll is around y and pitch around x. Azimuth is around z but left-hand rotated. So suggested to change the code to

Eigen::Quaterniond quat(Eigen::AngleAxisd(-ins_pva.azimuth * degrees_to_radians, Eigen::Vector3d::UnitZ()) *
                            Eigen::AngleAxisd(ins_pva.pitch * degrees_to_radians, Eigen::Vector3d::UnitX()) * 
                            Eigen::AngleAxisd(ins_pva.roll * degrees_to_radians, Eigen::Vector3d::UnitY()));
tf::quaternionEigenToMsg(quat, cur_odom_.pose.pose.orientation);

Activity

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Metadata

Metadata

Assignees

No one assigned

    Labels

    No labels
    No labels

    Type

    No type

    Projects

    No projects

      Milestone

      No milestone

      Relationships

      None yet

      Development

      No branches or pull requests

      Issue actions