Qt与OpenCASCADE工业机器人仿真：RRT路径规划及TCP/IP下发实战-平芜编程栈

简介：这份资源是一套基于Qt框架与OpenCASCADE几何内核构建的工业机器人仿真与路径规划系统源码，面向机器人研发工程师、自动化专业学生及需要搭建仿真验证环境的技术人员。系统支持ABB与ROKAE两大品牌机器人建模，集成碰撞检测与RRT路径规划算法，并可通过TCPIP通讯协议将规划结果下发至真实机器人，适合用于算法验证、教学演示与工程预研。压缩包共约2000个文件，以1175个C/C++头文件与728个cpp源文件为主体，辅以txt说明、json配置、md文档及少量Python、Shell脚本，整体约169.61MB，工程结构完整、模块划分清晰。目前已有177人学习下载。读者可从中获取完整的机器人建模、碰撞检测、RRT路径规划与通讯控制实现思路，对照源码理解各模块协作方式，并在此基础上进行二次开发或功能裁剪。

1. 从一台 ABB 机器人说起：这套 Qt + OpenCASCADE 仿真系统到底能干什么

去年帮一个做焊接集成的朋友排查问题，他现场那台 ABB IRB 2600 在示教器上跑得好好的，换了个工件之后轨迹就撞夹具。停机改代码、重新示教、再试，一天下来没跑通几条路径。他问我有没有办法先在电脑上把机器人模型和工件摆出来，把路径跑一遍看会不会撞，确认没问题再下发到真机。这个需求其实非常典型——工业机器人仿真与路径规划要解决的就是这件事：在虚拟环境里把机器人、工件、夹具搭起来，用算法算出一条无碰撞的轨迹，再通过通讯把关节角或位姿发给真实控制器。

这套资源就是围绕这个场景做的：基于Qt 框架做界面和交互，用OpenCASCADE 几何内核处理三维模型和碰撞检测，内置RRT 路径规划算法，支持ABB 和 ROKAE（珞石）两类机器人的建模，并且能通过TCP/IP 通讯把规划结果下发到真实机器人。它适合三类人：做机器人集成的现场工程师、研究路径规划算法的学生、以及需要快速搭一个仿真验证环境但不想从零造轮子的开发者。下面我按「资源是什么 → 怎么用 → 坑在哪」的顺序拆开讲，能抄的代码和参数我都放出来。

2. 环境搭建与工程结构：Qt 5.15 + OpenCASCADE 7.6 怎么配才不翻车

2.1 为什么是 Qt 5.15 而不是 Qt 6

这套工程用的是 Qt 5.15.2 的 MSVC2019 64bit 套件，不是 Qt 6。原因很实际：OpenCASCADE 7.6 的官方预编译包和 CMake 配置文件对 Qt 5 的支持最成熟，Qt 6 的 CMake 模块名和部分 API 有变动，直接迁过去会在Qt5Config.cmake和Qt6Config.cmake的查找逻辑上卡住。热搜里有人问「qt 编译时候 cannot find -lpublic」和「unknown module(s) in qt: webenginewidgets」，前者通常是 OpenCASCADE 的库路径没进LIBS，后者是装了 Qt 6 但工程还在找 Qt 5 的 WebEngine 模块——这套工程不需要 WebEngine，遇到这个报错直接检查.pro或CMakeLists.txt里有没有多余的QT += webenginewidgets。

安装顺序建议：先装 Visual Studio 2019（带 C++ 桌面开发负载），再装 Qt 5.15.2 并勾选 MSVC2019 64bit 组件，最后装 OpenCASCADE 7.6。三者位数必须一致，全是 64 位。装完 Qt 后如果发现只有 MinGW 没有 MSVC 套件，去 Qt Maintenance Tool 里补装 MSVC 编译工具链，热搜里「qt 按照完 mingw 编译器后怎么安装 msvc 编译工具链」问的就是这一步。

2.2 工程目录与关键文件

解压后的工程大致是这样一个结构，我按实际会碰到的文件列一下：

目录/文件	作用	是否要改
`RobotSim.pro`	qmake 工程文件，声明 Qt 模块和 OCCT 库	要改库路径
`src/main.cpp`	程序入口，初始化 QApplication	一般不动
`src/MainWindow.*`	主窗口，承载 3D 视图和控件	按需改
`src/OCCView.*`	OpenCASCADE 视图封装，负责显示和拾取	核心，慎改
`src/RobotModel.*`	机器人 DH 参数与连杆建模	换机器人要改
`src/CollisionDetector.*`	碰撞检测封装	调精度要改
`src/RrtPlanner.*`	RRT 路径规划实现	调算法要改
`src/TcpClient.*`	TCP/IP 通讯，下发轨迹	改 IP 和端口
`models/`	ABB、ROKAE 的 STEP/IGES 模型	可替换

.pro文件里最关键的是 OpenCASCADE 的库声明，常见写法是这样：

# RobotSim.pro 关键片段 QT += core gui widgets opengl # OpenCASCADE 头文件与库路径，按自己安装位置改 OCCT_DIR = C:/OpenCASCADE-7.6.0 INCLUDEPATH += $$OCCT_DIR/inc LIBS += -L$$OCCT_DIR/win64/vc14/lib # 按需链接 OCCT 模块，全链会拖慢编译 LIBS += -lTKernel -lTKMath -lTKG2d -lTKG3d -lTKGeomBase LIBS += -lTKBRep -lTKTopAlgo -lTKPrim -lTKBO -lTKBool LIBS += -lTKOpenGl -lTKService -lTKV3d -lTKHLR

这段配置的逻辑是：INCLUDEPATH告诉编译器去哪找 OCCT 头文件，LIBS的-L指定库目录，后面一串-l是按模块链接。TKernel和TKMath是基础，TKBRep和TKTopAlgo管拓扑和建模，TKBO/TKBool是布尔运算（碰撞检测会用到），TKOpenGl/TKV3d负责显示。参数上唯一要改的是OCCT_DIR，指向你自己的安装路径。如果链接时报cannot find -lTKxxx，先确认win64/vc14/lib下有没有对应的.lib，再确认位数是不是 64 位。

2.3 编译与首次运行

用 Qt Creator 打开.pro，选 MSVC2019 64bit 套件，直接构建。第一次编译大概三到五分钟。运行后如果 3D 视图是黑的但控件正常，八成是 OpenGL 上下文没建起来，检查显卡驱动，或者在main.cpp里显式设置QSurfaceFormat：

// main.cpp 里设置 OpenGL 格式，避免部分机器黑屏 QSurfaceFormat fmt; fmt.setDepthBufferSize(24); fmt.setStencilBufferSize(8); fmt.setVersion(3, 3); fmt.setProfile(QSurfaceFormat::CoreProfile); QSurfaceFormat::setDefaultFormat(fmt);

setDepthBufferSize(24)保证深度测试正常，不然模型会前后穿插；setVersion(3,3)和CoreProfile是让 OCCT 的TKOpenGl走现代管线。这一步不做，在某些集显机器上就是黑屏或者花屏，属于血泪经验。

3. 机器人建模与碰撞检测：DH 参数怎么填、碰撞对怎么配

3.1 ABB 与 ROKAE 的建模差异

这套系统对两类机器人的建模走的是同一条路：用 DH 参数描述连杆关系，再用 OpenCASCADE 把每个连杆的几何体（STEP 或 IGES）按 DH 变换摆到正确位置。ABB 的模型在models/abb/下，ROKAE 在models/rokae/下。区别在于 DH 参数表和关节零位定义不同，ABB 的零位和 ROKAE 的零位不能混用，换机器人时必须同时换模型文件和 DH 参数。

RobotModel里一般会有一个 DH 参数表，长这样：

// 六轴机器人 DH 参数，a/alpha/d/theta 单位分别为 mm 和 rad struct DHParam { double a, alpha, d, theta; }; std::vector<DHParam> dh = { { 0.0, -M_PI/2, 290.0, 0.0 }, // J1 { 270.0, 0.0, 0.0, -M_PI/2 }, // J2 { 70.0, -M_PI/2, 0.0, 0.0 }, // J3 { 0.0, M_PI/2, 302.0, 0.0 }, // J4 { 0.0, -M_PI/2, 0.0, 0.0 }, // J5 { 0.0, 0.0, 72.0, 0.0 } // J6 };

每个DHParam的四个量对应标准 DH 约定：a是连杆长度，alpha是连杆扭角，d是连杆偏距，theta是关节角。前三个是机器人固有参数，从手册查；theta是变量，由关节角驱动。这里填的是示例值，实际用哪台机器人就照它的手册填，填错了模型会歪，碰撞检测也跟着错。常见做法是先用示教器把机器人摆到零位，量一下各关节的实际角度，反推 DH 参数是否对得上。

3.2 碰撞检测的配置与精度

碰撞检测用的是 OpenCASCADE 的布尔相交判断：把两个形状做BRepAlgoAPI_Common，如果结果非空就说明相交。核心代码大致是这样：

// CollisionDetector.cpp 判断两个 TopoDS_Shape 是否碰撞 bool CollisionDetector::isColliding(const TopoDS_Shape& a, const TopoDS_Shape& b) { BRepAlgoAPI_Common common(a, b); common.SetFuzzyValue(0.1); // 容差，单位与模型一致 common.Build(); if (!common.IsDone()) return false; // 计算失败按不碰撞处理 return !common.Shape().IsNull(); // 有交集即碰撞 }

SetFuzzyValue(0.1)是容差，单位跟模型一致（这里是 mm）。容差太小，两个面贴在一起会误判为碰撞；太大，本来该撞的又漏判。我一般从 0.1 开始试，工件和夹具间隙在 1mm 以上时够用。IsDone()返回 false 说明布尔运算失败，可能是形状本身有问题（比如自相交），这时候要回去检查 STEP 模型。

碰撞对不是所有连杆两两都算，那样太慢。常见做法是只检测「可能相撞」的组合：相邻连杆不算（它们本来就挨着），末端工具和工件、工件和夹具、机器人和围栏这些才算。配置一般放在一个列表里：

// 碰撞对配置：first/second 是形状索引 std::vector<std::pair<int,int>> pairs = { {TOOL_ID, WORKPIECE_ID}, {WORKPIECE_ID, FIXTURE_ID}, {ROBOT_BASE_ID, FENCE_ID} };

这样能把检测次数从几十次降到几次，实时性才够。如果发现规划出来的路径明明会撞却没报，先查这个列表有没有漏配。

3.3 把模型摆到正确位置

模型导入后默认在原点，要按工件坐标系摆。用gp_Trsf做变换：

// 把工件按给定位姿摆到工作台 gp_Trsf trsf; trsf.SetTranslation(gp_Vec(x, y, z)); gp_Quaternion q(gp_Vec(1,0,0), angle); // 绕轴旋转 trsf.SetRotation(q); BRepBuilderAPI_Transform xform(workpiece, trsf, true); TopoDS_Shape placed = xform.Shape();

SetTranslation平移，SetRotation旋转，BRepBuilderAPI_Transform的第三个参数true表示复制，不改原形状。位姿数据一般来自标定或者图纸，摆错了后面全错。我习惯摆完之后在视图里量一下关键尺寸，跟图纸对一遍再往下走。

4. RRT 路径规划与 TCP/IP 下发：从算法到真机的最后一公里

4.1 RRT 在关节空间还是笛卡尔空间

这套系统的 RRT 跑在关节空间，也就是在六个关节角组成的六维空间里采样。为什么不用笛卡尔空间？因为笛卡尔空间的碰撞检测要反复做逆解，慢且容易碰到奇异点。关节空间直接采样关节角，正解算末端位姿，再做碰撞检测，流程更顺。

RRT 的核心是「随机采样 + 最近邻扩展 + 碰撞检查」：

// RrtPlanner.cpp 单次扩展 Node RrtPlanner::extend(const Node& nearest, const Node& rand) { // 朝随机点方向走一步，步长 stepSize Node newNode = steer(nearest, rand, stepSize); if (!isStateValid(newNode)) return nearest; // 无效就退回 tree.addNode(newNode); tree.addEdge(nearest, newNode); return newNode; } bool RrtPlanner::isStateValid(const Node& n) { // 正解算末端，再对所有碰撞对做检测 auto shapes = forwardKinematics(n); for (auto& p : collisionPairs) if (detector.isColliding(shapes[p.first], shapes[p.second])) return false; return true; }

stepSize是每次扩展的步长，关节空间里单位是弧度，一般取 0.1 到 0.3。太小收敛慢，太大容易跳过窄通道。isStateValid是性能瓶颈，每次都要正解加碰撞检测，所以碰撞对要精简。如果规划一直失败，先看stepSize是不是太大，再看碰撞对是不是配多了导致可行域被误判没了。

4.2 双向 RRT 与路径平滑

单向 RRT 在窄通道里收敛慢，热搜里「双向 rrt」就是针对这个的改进：从起点和终点各长一棵树，交替扩展，两棵树接上就停。这套系统里可以切换单向和双向，双向的收敛速度在复杂场景下能快好几倍。规划出来的原始路径是折线，关节角跳变，直接下发会抖，所以要做平滑：

// 对原始路径做 shortcut 平滑 Path RrtPlanner::smooth(const Path& raw, int iters) { Path p = raw; for (int i = 0; i < iters; ++i) { int a = rand() % p.size(); int b = rand() % p.size(); if (a > b) std::swap(a, b); if (canConnect(p[a], p[b])) { // 两点间直线无碰撞 p.erase(p.begin()+a+1, p.begin()+b); } } return p; }

canConnect在两点之间插值采样，逐点做碰撞检测，全通过才删中间点。iters取 50 到 200，越多越平滑但越慢。平滑完的路径关节角变化连续，下发到真机才不抖。

4.3 TCP/IP 下发到真实机器人

下发走 TCP/IP，机器人控制器当服务端，这套系统当客户端。ABB 一般用 5000 端口（具体看控制器配置），ROKAE 的端口和协议要查它的通讯手册。核心代码：

// TcpClient.cpp 连接并下发轨迹 bool TcpClient::connectToRobot(const QString& ip, quint16 port) { socket.connectToHost(ip, port); return socket.waitForConnected(3000); // 3 秒超时 } void TcpClient::sendTrajectory(const Path& path) { QByteArray buf; for (const auto& node : path) { for (double j : node.joints) { buf.append(QString::number(j, 'f', 4).toUtf8()); buf.append(','); } buf.append(';'); } socket.write(buf); socket.flush(); }

connectToHost后必须waitForConnected，不然连没连上不知道。sendTrajectory把每个路径点的六个关节角拼成字符串，点之间用;分隔，关节角之间用,分隔。这个格式是自定义的，真机端要写对应的解析。下发前一定要在仿真里把整条路径再跑一遍碰撞检测，确认无碰撞再发，不然真机撞了就是事故。我一般会先在低速模式下试跑第一条，确认没问题再放开速度。

5. 避坑与排查：这几类问题我踩过不止一次

5.1 编译期找不到 OCCT 库

现象：链接报cannot find -lTKernel或一堆undefined reference。原因：LIBS里的库路径不对，或者位数不匹配（32 位库配 64 位工程）。解决：确认OCCT_DIR/win64/vc14/lib存在且是 64 位，把-L路径写成绝对路径，别用相对路径。如果还不行，用dumpbin /headers xxx.lib看库的机器类型是不是 x64。

5.2 运行后 3D 视图黑屏

现象：窗口出来了，控件正常，但三维区域全黑。原因：OpenGL 上下文没建起来，或者显卡驱动太旧。解决：在main.cpp里显式设置QSurfaceFormat（见 2.3 的代码），更新显卡驱动。如果是远程桌面里跑，某些 OpenGL 版本不支持，换本地跑。

5.3 碰撞检测误报或漏报

现象：明明没碰却报碰撞，或者碰了却不报。原因：SetFuzzyValue容差设得不合适，或者碰撞对配错。解决：容差从 0.1 开始调，间隙大的场景可以到 0.5；检查碰撞对列表，确认该检测的组合都在里面，不该检测的（比如相邻连杆）没在里面。

5.4 RRT 规划一直失败

现象：跑很久都找不到路径。原因：stepSize太大跳过窄通道，或者碰撞对配多了把可行域误判没了，或者起点终点本身就在碰撞状态。解决：先把stepSize降到 0.1，再检查起点终点的isStateValid是不是 true，最后精简碰撞对。如果还不行，换双向 RRT。

5.5 下发后真机不动或报错

现象：仿真里跑得好好的，发下去真机没反应或者报通讯错误。原因：IP 或端口不对，或者数据格式跟控制器要求的不一致。解决：先用ping确认网络通，再用调试工具（比如nc或串口助手）手动发一条测试指令看控制器回什么。数据格式一定要照控制器手册来，别自己发明。

6. 进阶：把 RRT 换成双向 + 动态重规划的一个实用技巧

前面讲的都是静态场景：工件摆好，规划一次，下发。但实际现场经常有动态障碍，比如变位机在动、另一个机器人也在同一工作区。这时候一次性规划不够用，得做动态重规划。我的做法是在 RRT 外面套一层循环：每隔固定时间（比如 200ms）重新检测当前路径是否还有效，无效就以上一个有效路径点为起点重新规划。

// 动态重规划循环 Path current = planner.plan(start, goal); while (!reached(goal)) { QThread::msleep(200); if (!planner.pathStillValid(current)) { Node newStart = current.front(); // 从当前点重新规划 current = planner.plan(newStart, goal); } tcpClient.sendTrajectory(current); }

pathStillValid对整条路径逐点做碰撞检测，newStart取当前路径的第一个点，保证重规划从机器人当前位置开始，不会跳。QThread::msleep(200)是重规划周期，太快浪费算力，太慢反应不过来，200ms 是个折中。这个循环要放在独立线程里，别阻塞界面。

验证方法很简单：在仿真里放一个会动的障碍物，看机器人能不能绕开。我一般会先让障碍物慢速移动，确认重规划触发正常，再加速。如果发现机器人卡住不动，先看pathStillValid是不是一直返回 false（可能容差太小），再看重规划有没有真的执行（加日志）。

从那以后我每次下发真机之前，都强制走一遍「仿真全路径碰撞检测 + 低速试跑第一条」的流程，不管多急都不跳。这套 Qt + OpenCASCADE 的仿真系统把建模、碰撞、规划、通讯串成了一条线，省掉的是现场反复示教的时间，值不值得下，看你有没有被真机撞过。希望帮到你。

本文还有配套的精品资源，点击获取