使用RLmdl库进行机器人运动学求解

引言


机器人库Robotics Library 是一个独立的C++库,用于机器人运动学,运动规划和控制。它涵盖了数学,运动学和动力学,硬件抽象,运动规划,碰撞检测和可视化。
RLmdl是机器人库中的一个功能组件。
RLmdl提供基于空间矢量代数并支持分支的运动学和动力学计算。支持各种关节类型(例如,旋转,棱柱形,圆柱,螺旋形)和算法(例如,正向运动学,通过递归牛顿-欧拉的逆动力学以及通过铰接体的正向动力学)。

例子

下面是使用RLmdl的一个例子,简要说明了rlmdl库中用于机器人运动学的关键函数。


   std::shared_ptr<rl::mdl::Kinematic> kinematic;
   rl::mdl::UrdfFactory factory;
   //运动学参数,参数为文件名
   kinematic = std::dynamic_pointer_cast<rl::mdl::Kinematic>(factory.create(m_urdffile.toStdString()));
   //正向运动学
   rl::math::Vector q;
   q<<0,0,0,0;
   kinematic->setPosition(q);
   kinematic->forwardPosition();
   //获取正向运动学结果
    rl::math::Vector3 position =  //位置
      kinematic-> getOperationalPosition(0). translation();
    rl::math::Vector3 orientation =  //姿态
      kinematic->getOperationalPosition(0). rotation().eulerAngles(2, 1, 0).reverse();

   //逆向运动学-Jacobian
    rl::mdl::JacobianInverseKinematics ik(kinematic.get());
    rl::math::Transform T =kinematic->getOperationalPosition(0);
    ik.addGoal(T, 0);
    bool result = ik.solve();
    //逆向运动学-Nlopt
    rl::mdl::NloptInverseKinematics ik2(kinematic.get());
    rl::math::Transform T2 =kinematic->getOperationalPosition(0);
    ik2.addGoal(T2, 0);
    bool result2 = ik2.solve();

    //获取反解结果
   rl::math::Vector joints = kinematic->getPosition();
  • 0
    点赞
  • 4
    收藏
    觉得还不错? 一键收藏
  • 2
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 2
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值