gazebo publish pose

本文档展示了如何在GimbalSmall2dPlugin的基础上,改进姿态消息的发布效率,并利用Gazebo API进行精确控制。着重于模型加载、关节操作与PID控制器的整合,以及世界更新事件的响应优化。

在GimbalSmall2dPlugin.cc 基础上修改

origin    https://github.com/khancyr/ardupilot_gazebo (fetch)

  public: transport::PublisherPtr pub,posepub;

 

  this->dataPtr->posepub =
    this->dataPtr->node->Advertise<gazebo::msgs::Pose>(std::string("~/") +
    this->dataPtr->model->GetName() + "/copter_pose");

 

gazebo::msgs::Pose p=gazebo::msgs::Convert(this->dataPtr->model->GetWorldPose().Ign () );

    this->dataPtr->posepub->Publish(p);

 

参考api

http://osrf-distributions.s3.amazonaws.com/gazebo/api/7.1.0/classgazebo_1_1math_1_1Pose.html

http://osrf-distributions.s3.amazonaws.com/gazebo/api/7.1.0/group__gazebo__msgs.html

http://osrf-distributions.s3.amazonaws.com/gazebo/api/7.1.0/classgazebo_1_1physics_1_1Entity.html#a3fb9c33d26b0c46dd6f735f39bbd15de

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值