C++ (Cpp) Pose::setRotation Examples

Example #1

File: pose.cpp Project: akab/SLAM_2D

Pose Pose::inverse() {
    Pose ret;
    ret.setRotation(_R.inverse());
    ret.setAngle(normalize_angle(ret._R.angle()));
//#ifdef _MSC_VER
//  ret._t=ret._R*(Vector2d(_t*-1.));
//#else
    ret.setTranslation(ret._R*(_t*-1.));
//#endif
    return ret;
}