cmd_to_robot 讨论及 G29 控制优化

cmd_to_robot 讨论及 G29 控制优化

cmd_to_robot 讨论

转向电机控制代码中,补偿信息在循环中发布,转向完成信息在回调函数中发布

转动电机控制代码中,对转动电机的控制在转向完成的回调函数中实现

这就意味着如果一直没有 /cmd_vel 消息发布,那么就没有转动电机的控制,从而导致控制时的异常

简单的方法是上电时先启动手柄节点,轨迹跟踪时再关闭手柄节点,即由不同的节点发布 /cmd_vel 消息,后续再考虑优化

G29 控制优化

G29 的控制消息是间断的,即动一下发一下,不会像手柄那样连续发送,这样会导致两个问题:

  • 通信的不连续或者长时间未发送消息导致通信异常
  • 控制的不连续导致转动电机异常动作

因此考虑将 /joy 消息订阅后连续发送,代码如下

cpp 复制代码
#include <ros/ros.h>
#include <sensor_msgs/Joy.h>
#include <mutex>
using namespace std;

ros::Publisher continuous_pub;
sensor_msgs::Joy steer_msg;
mutex mut;

const int axis_button_num = 20;

void joy_callback(const sensor_msgs::Joy::ConstPtr &msg)
{
    steer_msg = *msg;
    lock_guard<mutex> lck(mut);
    continuous_pub.publish(steer_msg);
    mut.unlock();
}

int main(int argc, char *argv[])
{
    ros::init(argc, argv, "g29_continuous");
    ros::NodeHandle nh;
    memset(&steer_msg, 0, sizeof(steer_msg));
    steer_msg.axes.resize(axis_button_num);
    steer_msg.buttons.resize(axis_button_num);

    continuous_pub = nh.advertise<sensor_msgs::Joy>("/g29_msg", 1);
    ros::Subscriber joy_sub = nh.subscribe("/joy", 1, joy_callback);

    ros::Rate loop(25);
    while (ros::ok())
    {
        lock_guard<mutex> lck(mut);
        continuous_pub.publish(steer_msg);
        mut.unlock();
        ros::spinOnce();
        loop.sleep();
    }

    return 0;
}

有新的 sensor_msgs::Joy 就更新 steer_msg,否则就发布之前的 msg

💡 注意 resize 键轴和按钮,否则 robot_steerpub 会因为越界访问而报段错误

远程控制的完整通信流程如下

相关推荐
Mr.Winter`2 小时前
轨迹优化 | 基于激光雷达的欧氏距离场ESDF地图构建(附ROS C++仿真)
c++·人工智能·机器人·自动驾驶·ros·ros2·具身智能
Blossom.11819 小时前
机器学习在智能制造业中的应用:质量检测与设备故障预测
人工智能·深度学习·神经网络·机器学习·机器人·tensorflow·sklearn
MidJourney中文版1 天前
深度报告:中老年AI陪伴机器人需求分析
人工智能·机器人
微小冷2 天前
二关节机器人系统模型推导
线性代数·机器人·概率论·推导·拉格朗日函数·二关节机器人·机器人控制系统的设计
kyle~2 天前
计算机视觉---RealSense深度相机技术
人工智能·数码相机·计算机视觉·机器人·嵌入式·ros·传感器
视觉语言导航2 天前
RAL-2025 | 清华大学数字孪生驱动的机器人视觉导航!VR-Robo:面向视觉机器人导航与运动的现实-模拟-现实框架
人工智能·深度学习·机器人·具身智能
BFT白芙堂2 天前
睿尔曼系列机器人——以创新驱动未来,重塑智能协作新生态(上)
人工智能·机器学习·机器人·协作机器人·复合机器人·睿尔曼机器人
Blossom.1183 天前
机器学习在智能建筑中的应用:能源管理与环境优化
人工智能·python·深度学习·神经网络·机器学习·机器人·sklearn
Mr.Winter`3 天前
障碍感知 | 基于3D激光雷达的三维膨胀栅格地图构建(附ROS C++仿真)
人工智能·机器人·自动驾驶·ros·具身智能·环境感知
AiTEN_Robot3 天前
AGV 无人叉车关键技术问题解析:精准定位算法 / 安全避障逻辑 / 系统对接协议全方案
人工智能·机器人·自动化·制造