并联四足机器人项目开源教程（四） --- 使用QT创建控制上位机

最新推荐文章于 2025-03-26 21:54:13 发布
最新推荐文章于 2025-03-26 21:54:13 发布
阅读量3.2k 收藏 44
点赞数 5
分类专栏： 四足机器人项目开源 文章标签： 机器人 ROS QT ui
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/weixin_45728705/article/details/127162344
版权

在这里插入图片描述
这个是本人在大三期间做的项目 ---- 基于MIT的Cheetah方案设计的十二自由度并联四足机器人，这个项目获得过两个国家级奖项和一个省级奖项。接下来我会将这个机器人的控制部分所有代码进行开源，并配有相关的教程博客，希望能够帮助到在学习相关领域知识或者进行项目开发的同学。

学习建议

QT是一个跨平台的 C++ 开发库，主要用来开发图形用户界面（Graphical User Interface，GUI）程序，当然也可以开发不带界面的命令行。由于它可视化界面的操作便捷，拓展性强以及对各平台的兼容性高，非常适用于机器人操作UI的开发。
因此，本项目基于QT开发平台，并结合了ROS，设计了一套用于人机交互的四足机器人操作UI界面。

学习资料：因为QT的生态已经非常成熟了，网上有数不清的QT开源项目，所以学习成本很低。并且制作上位机最难的不是各种语法（只要有一定的C++代码基础），而是审美，所以建议找到相关的开源项目直接上手，实践出真知。
B站相关教程：QT入门到实战
相关开源项目及教程：ROS&Qt5 人机交互界面开发
本项目上位机开源代码： Quadruped_UpperMonitor

学习内容

这里不展开讲QT的语法实现，主要讲本项目所需的上位机功能以及界面设计。

QT与ROS的关系： QT上位机一般作为一个节点接入到ROS网络中，并且将ROS的通信函数嵌入到QT的控件SLOT函数中，进行数据交互。

机器人操作界面

单关节控制界面（用于驱动测试以及极性测试）
在这里插入图片描述

/* 以下是滑条的嵌套函数截取，仅供参考 */

/**
 * @brief 控制单关节
 * @param id 关节号（1-12）
 */
void MainWindow::JointCtrl(JOINT l, float data)
{
    sensor_msgs::JointState msg;
    msg.name.push_back(std::to_string(l));
    msg.position.push_back(data);
    qnode->JointCmdPuber.publish(msg);
}

/**
 * @brief 控件初始化函数
 */
void MainWindow::InitWidget(void)
{
    // 滑块移动时显示数值
    connect(ui->Slider_LBjoint1,&QSlider::sliderMoved,[=]() {
        ui->Num_LBjoint1->display(ui->Slider_LBjoint1->value());
    });
    connect(ui->Slider_LBjoint2,&QSlider::sliderMoved,[=]() {
        ui->Num_LBjoint2->display(ui->Slider_LBjoint2->value());
    });
    connect(ui->Slider_LBjoint3,&QSlider::sliderMoved,[=]() {
        ui->Num_LBjoint3->display(ui->Slider_LBjoint3->value());
    });

    // 滑块松开时发布控制数据，ang_bias是角度偏置，与腿部坐标系建立和初始相位有关。
    connect(ui->Slider_LBjoint1,&QSlider::sliderReleased,[=]() {
       JointCtrl(JOINT_LB1, ui->Slider_LBjoint1->value()*Angle2Pi);
    });
    connect(ui->Slider_LBjoint2,&QSlider::sliderReleased,[=]() {
       JointCtrl(JOINT_LB2, ui->Slider_LBjoint2->value()*Angle2Pi - ang_bias);
    });
    connect(ui->Slider_LBjoint3,&QSlider::sliderReleased,[=]() {
       JointCtrl(JOINT_LB3, ui->Slider_LBjoint3->value()*Angle2Pi + ang_bias);
    });

运动控制界面（人机交互主要的界面）
功能描述：

  1. 支持修改机器人运动参数：步态类型，速度，身高，步高等
  2. 键盘控制机器人运动
    在这里插入图片描述
/* 以下是本项目中键盘控制的部分代码截取，仅供参考 */

/**
 * @brief 键盘按键松开回调函数
 */
void MainWindow::keyReleaseEvent(QKeyEvent *event){
    // 判断模式
    if(ui->rBtn_Joystick->isChecked() && ctrlEnable){
        switch(event->key()){
	        // 状态控制
	        case Qt::Key_Space:
	            joystick.jump_triggle = 1;
	            break;
	
	        // 速度控制
	        case Qt::Key_W: joystick.v_des[0] = 0; 	break;
	        case Qt::Key_S: joystick.v_des[0] = 0; 	break;
	        case Qt::Key_A: joystick.v_des[1] = 0; 	break;
	        case Qt::Key_D: joystick.v_des[1] = 0; 	break;
	        case Qt::Key_Q: joystick.v_des[2] = 0;  	break;
	        case Qt::Key_E: joystick.v_des[2] = 0; 	break;
	
	        // 参数控制
	        case Qt::Key_G:
	            cur_gait = (cur_gait + 1) % Gait_Num;
	            ui->tBtn_Gait->menu()->actions()[cur_gait]->trigger();
	            break;
	        case Qt::Key_H:
	            cur_jump = (cur_jump + 1) % 3;
	            ui->tBtn_Jump->menu()->actions()[cur_jump]->trigger();
	            break;
	        case Qt::Key_U:
	            ui->pBar_Velocity->setValue(ui->pBar_Velocity->value() + 10);
	            break;
	        case Qt::Key_J:
	            ui->pBar_Velocity->setValue(ui->pBar_Velocity->value() - 10);
	            break;
	        case Qt::Key_I:
	            ui->pBar_Omega->setValue(ui->pBar_Omega->value() + 10);
	            break;
	        case Qt::Key_K:
	            ui->pBar_Omega->setValue(ui->pBar_Omega->value() - 10);
	            break;
     	}
    }
}

/**
 * @brief 键盘按键按下回调函数
 */
void MainWindow::keyPressEvent(QKeyEvent *event){
    switch(event->key()){
        case Qt::Key_Return:
  
            // 步态类型
            if(gait_type == QString("Stand")) joystick.gait = 1;
            else if(gait_type == QString("Trot")) joystick.gait = 2;
            else if(gait_type == QString("Walk")) joystick.gait = 3;

            // 跳跃类型
            if(_jump == QString("Jump")) joystick.jump_type = 0;
            else if(_jump == QString("Jump_L")) joystick.jump_type = 1;
            else if(_jump == QString("Jump_H")) joystick.jump_type = 2;

	        // 速度控制
	        case Qt::Key_W: joystick.v_des[0] = ui->pBar_Velocity->value() / 100. * 0.3f; 		break;
	        case Qt::Key_S: joystick.v_des[0] = -ui->pBar_Velocity->value() / 100. * 0.3f; 		break;
	        case Qt::Key_A: joystick.v_des[1] = ui->pBar_Velocity->value() / 100. * 0.15f;  		break;
	        case Qt::Key_D: joystick.v_des[1] = -ui->pBar_Velocity->value() / 100. * 0.15f; 		break;
	        case Qt::Key_Q: joystick.v_des[2] = ui->pBar_Omega->value() / 100. * 0.3f;			break;
	        case Qt::Key_E: joystick.v_des[2] = -ui->pBar_Omega->value() / 100. * 0.3f; 			break;
    }
}

信号发生器界面

用于发布正弦波，三角波等控制信号，以测试控制器的响应性能。
在这里插入图片描述

/* 以下是本项目中曲线控制信号生成的部分代码截取，仅供参考 */

/**
曲线参数结构体
**/
typedef struct{
	// 
    Curve_Type curve_type;	// 曲线类型
    // 3代表xyz3个轴系，因为是对每个轴系分别施加控制信号，所以需要分开存储曲线参数
    uint32_t freq[3];			// 频率
    float amp[3];					// 幅值
    float origin[3];				// 初始相位
    float Kp[3];					// PID的比例系数
    float Kd[3];					// PID的微分系数
    bool axis_enable[3];	// 轴系使能标志位
    bool legs_enable[4];	// 腿部使能标志位，4代表4条腿
}Curve_Inf;

/**
 * @brief 曲线输出信号计算函数
 */
void calculateCurve(Curve_Inf* _curve, std::vector<sensor_msgs::JointState>& _msgs){
		
	    float scale, pDes[3], vDes[3];
	    int real_time = QDateTime::currentDateTime().toMSecsSinceEpoch();
	    // 根据曲线类型确定输出
	    for(int i = 0; i < 3; i ++){
	        if(_curve->axis_enable[i]){
	        		// 参数存储
		           float start = _curve->origin[i];
		            float phase = (real_time % int(1. / _curve->freq[i] * 1000.)) / (1. / _curve->freq[i] * 1000.);
		            float amp = _curve->amp[i];
		            float freq = _curve->freq[i];
		            switch (_curve->curve_type) {
		            	// 正弦波
			            case Curve_Sin:
			                scale = phase < 0.5f ? sin(M_PI * 2 * phase) : 0;
			                vDes[i] = amp * cos(M_PI * 2 * phase);
			                break;
			                
			             // 三角波
			            case Curve_Triangle:
			                vDes[i] = (phase < 0.5f) ? amp * freq * 4.f : -amp * freq * 4.f;
			                if(phase < 0.5f){
			                    start -=  amp;
			                    scale = 2 * vDes[i] * phase;
			                }
			                else{
			                    start +=  0.5 * amp;
			                    scale = 2 * vDes[i] * (phase - 0.5f);
			                }
			                break;
			                
			             // 方波
			            case Curve_Quare:
			                scale = phase > 0.5 ? -1. : 1.;
			                vDes[i] = 0;
			                break;
			            default:
			                break;
			            }
			            // 记录目标位置
			            pDes[i] = start + scale * amp;
			        }
    }


    // 信号输出
    _msgs.clear();
    for(int leg = 0; leg < 4; leg ++){
        if(_curve->legs_enable[leg]){
        	// 输出离散目标位置
            msg.position.push_back(_curve->axis_enable[0]? pDes[0] : _curve->origin[0]);
            msg.position.push_back(_curve->axis_enable[1]? pDes[1] : _curve->origin[1]);
            msg.position.push_back(_curve->axis_enable[2]? pDes[2] : _curve->origin[2]);
            for(int i = 0; i < 3; i ++) msg.position.push_back(_curve->Kp[i]);
			// 输出离散目标速度 
            msg.velocity.push_back(_curve->axis_enable[0]? vDes[0] : 0);
            msg.velocity.push_back(_curve->axis_enable[1]? vDes[1] : 0);
            msg.velocity.push_back(_curve->axis_enable[2]? vDes[2] : 0);
            for(int i = 0; i < 3; i ++) msg.velocity.push_back(_curve->Kd[i]);

            msg.name.push_back(std::to_string(leg));
            _msgs.push_back(msg);
        }
    }
}

曲线观测界面

用于接收ROS网络中其他节点发布过来的数据，并定频实时显示。
多条曲线的实时显示，需要用到定时器以及多线程，即QT中的QTime和QThread。
在这里插入图片描述

/* 以下是本项目中曲线绘制的部分代码截取，仅供参考 */


/**
 * @brief 曲线输出信号计算函数
 */
void GraphThread::createItem()
{
	int m_iThreadCount = 4;//开启的线程个数
    for(int i = 0;i < m_iThreadCount;i++)
    {
        QTimer *timer = new QTimer();
        QThread  *thread = new QThread();
        m_qTimerList.append(timer);
        m_threadList.append(thread);
    }
}

/**
 * @brief 多线程开启
 */
void GraphThread::startMultThread(int dt = 5)
{
    // 设置图表更新时间间隔
    dtGraph = dt;

    for(int i = 0; i < m_qTimerList.size(); i++)
    {
        m_qTimerList.value(i)->start(dtGraph);
        m_qTimerList.value(i)->moveToThread(m_threadList.value(i));
        switch(i){
            case 0: QObject::connect(m_qTimerList.value(i),SIGNAL(timeout()),this,SLOT(realtimeGraph1()),Qt::DirectConnection); break;
            case 1: QObject::connect(m_qTimerList.value(i),SIGNAL(timeout()),this,SLOT(realtimeGraph2()),Qt::DirectConnection); break;
            case 2: QObject::connect(m_qTimerList.value(i),SIGNAL(timeout()),this,SLOT(realtimeGraph3()),Qt::DirectConnection); break;
            case 3: QObject::connect(m_qTimerList.value(i),SIGNAL(timeout()),this,SLOT(realtimeGraph4()),Qt::DirectConnection); break;
        }
        m_threadList.value(i)->start();
    }
}

/**
 * @brief UI绘制曲线
 * @param id
 * @return
 */
void graphplot::slot_plotGraph(int id){
    if(enabled[id]){
        for(int i = 0; i < 3; i ++){
            graph_checkboxes[id][i]->setText(graphList.at(id)->graph(i)->name());
            if(!graph_checkboxes[id][i]->isChecked()) graphList.operator [](id)->graph(i)->setVisible(false);
            else graphList.operator [](id)->graph(i)->setVisible(true);
        }
        graphList.operator [](id)->replot();
    }
}

/**
 * @brief 控件初始化函数
 */
void graphplot::initWidget(void){
    graph_threads->createItem();
    graph_threads->startMultThread(25);
    QObject::connect(graph_threads, SIGNAL(plotGraph(int)), this, SLOT(slot_plotGraph(int)));
}

/**
 * @brief 更新曲线数据
 */
void GraphThread::slot_updateGraphData(float* value, QString* name){
    // 获取当前时间
    double key = QDateTime::currentDateTime().toMSecsSinceEpoch()/1000.0;
    if(Timer_firstRun){
        Timer_startTime = key;
        Timer_firstRun = 0;
    }

    // 上写锁，更新曲线的存储数据
    rwlocker.lockForWrite();
    for(int i = 0; i < 4; i ++){
        if(clearflag[i]){
            for(int j = 0; j < 3; j ++){
                if(!graph_container[i][j].empty())
                graph_container[i][j].clear();
            }
        }
        setClearFlag(i,false);
    }

    PointType p;
    p.stamp = key-Timer_startTime;
    for(int i = 0; i < 4; i ++){
        for(int j = 0; j < 3; j ++){
            if(graph_container[i][j].size() > 100) graph_container[i][j].clear();
            else{
                p.name = name[i*3 + j];
                p.value = value[i*3 + j];
                graph_container[i][j].append(p);
            }

        }
    }
    // 解锁
    rwlocker.unlock();
}

说明：上面列举的所有代码，都是项目中的部分代码截取，也是所对应界面的核心部分代码，能够理解的话，重新编写自己的功能代码应该不难。完整的项目代码也在上方开源了，欢迎下载。

UDS升级入门，手把手教你——QT上位机开发1
不断debug，优化中……
03-24 1463
新建立一个工程，或者网找一个demo工程，在原有的基础进行开发（建议使用第二种）。目标：以500k/s的波特率与MCU进行CAN通信，可发可收。需要用到周立功 相关接口，拿到库文件，进行二次开发。选择正常模式、单滤波、500kbps、报文全接收。并链接上这个库，进行can通信开发。以下就是库，暴露出来can通信接口。具体接口使用可以看文档。CAN设备：开启和关闭。
QT上位机开发
嵌入式分享
05-27 5523
本文只介绍Windows的QT上位机开发，以串口为例，QT版本为5.15。
【开源、应用】QT—TCP网络上位机的设计
qq_53734051的博客
09-25 1万+
本文设计一个终端控制的上位机软件（如“设计目标”下图所示），可以和STM32、Adruino等通信实现无线局域网控制系统。
Linux上位机开发实践（开源框架和开源算法）
最新发布
嵌入式-老费，一个分享专业嵌入式知识的blog
03-26 672
【 声明：版权所有，欢迎转载，请勿用于商业用途。 联系信箱：feixiaoxing @163.com】         做嵌入式软件开发，如果软件本身比较简单，只是图形界面显示，那么相关的开发工作并不难。最主要的内容也就是数据通讯和协议分析，这类软件一般涉及不到开源方案。此时需要做的，就是做一个软件界面，设计一个交互逻辑，拿到对方的协议数据，做一个展示、分析或者记录即可。这方面，即使没有现成的软件模板，写起来也不会很复杂。         还有一类软件，开发工作较多，涉及到界面、算法、通信、保存和运
QT上位机开发入门教程：001点亮虚拟数码管
ic2121的博客
12-10 700
说明：先获取当前时间，然后将时间信息转化为字符串，那个时间转字符串是有格式说明的，hh:mm:ss，这三个分别代表小时分钟秒，中间是分隔符，可以选中改函数后按F1查看详细的说明。一共8位，所以我这里就设置为8.这是设置为默认值的，程序里也可以修改属性里的所有参数的。接下来进入一个关键的设置，就是设置数码管的位数，比如你买数码管都是要考虑显示多少位的数字或字符的。另外如果你忘了在小挂件属性设置显示的位数，默认是显示5位，你会看到mm:ss的信息，而看不到hh。启动定时器，设置为500ms超时信号。
QCM学习—基于QT自制上位机（多线程）
yydsshuai的博客
11-11 1362
QT上位机浅试多线程
QT实现简单的上位机软件
热门推荐
abczdefg的博客
08-06 3万+
QT实现简单的上位机软件
Qt之上位机开发实战（一）
qq_39993800的博客
11-14 5361
其中接受框使用Plain Text Edit（设置只读），串口号等按钮使用Combo Box，发送框使用Line Edit，其余按钮为Push Button，选项值设置双击Combo Box即可。然后我们将Qt切换到Release模式运行，这样我们就会得到一个.exe可执行文件，然后我们在桌面上新建文件并且将可执行文件复制到刚刚创建的文件下。Qt串口这里我们用到一个很关键的类serialport，在Pro文件下我们需要添加它。串口收发时使用信号槽实现的需要手动关联，首先在widget.h中的槽下声明。
QT串口助手机器人上位机
04-15
QT编写的通过串口实现的机器人上位机例程，可执行源码
运动控制系统上位机C#源码，可用于雕刻机，切割机，写字机，点胶机。 功能描述： 1.
KlSSYkTVSQl的博客
07-06 700
综上所述，我们的运动控制系统上位机软件是一款功能强大、操作便捷的工具，具备自动解析Gcode、图形还原显示、显示g代码坐标文件、回原点控制、手动控制3轴运动、图形缩放和鼠标拖动等多项实用功能。为了方便用户对这些设备进行控制和管理，我们开发了一款基于C#的上位机软件，该软件具备多项强大的功能，能够满足用户的各种需求。其次，我们的上位机软件支持图形还原显示。用户可以通过鼠标操作，实现对图形的放大缩小和移动，方便用户对设备的操作和监控。用户可以通过软件界面，手动控制设备在3个轴向上的运动，实现对设备的精确控制。
机器人 控制器上位机
12-04
机器人控制器上位机，可完成机器人的调试和编程
上位机开发【移动机器人】源码和注解
03-25
实际开发的一个移动机器人项目上位机源码，团队开发的，注解可能不是很详细，可以做一个c#开发的参考例子
编写简单的上位机（QT5串口编程）
11-06
编写简单的上位机（QT5串口编程）
QT5串口编程——编写简单的上位机
12-27
博客在https://blog.csdn.net/u014695839/article/details/50611549，重新上传了一份串口上位机实例的代码
Qt上位机开发入门（PCAN）
qq_58368698的博客
12-07 2705
PCAN二次开发，QT上位机开发
如何用Qt搭建一个方便扩展的通用上位机平台
avrdpy的专栏
03-31 527
通用上位机平台
Qt之上位机开发实战（三）
qq_39993800的博客
11-15 955
udp相对于tcp来说相对简单，udp不分客户端和服务器，只需要使用一个QUdpSocket类，首先完成布局。最后可以下载网络连接助手进行测试。.h文件public下创建对象。定义槽函数，.h文件下。
QT上位机开发（动画效果）
嵌入式-老费，一个分享专业嵌入式知识的blog
01-15 771
【 声明：版权所有，欢迎转载，请勿用于商业用途。 联系信箱：feixiaoxing @163.com】 不管是仿真，还是对真实环境的一比一模拟，动画都是非常好的一种呈现方式。目前在qt上面，实现动画主要有两种方法。一种，就是自己用定时器和canvas实现动画，这种情况比较适合复杂或者是定制类的动画；另外一种，qt本身也提供了各种各样的动画类，比如QPropertyAnimation，利用这些类同样可以实现动画的效果。今天，我们就用后面一种方法实现一下。
评论
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

煜个头头

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付：¥1
获取中
扫码支付

您的余额不足，请更换扫码支付或充值

打赏作者

实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

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

余额充值