南京全控科技
400 025 3599
联系我们
电话咨询
400 025 3599
返回顶部
当前位置: 新闻中心 > 技术文档 >
六自由度运动平台原理详解:Stewart结构、运动学与控制闭环
发布时间:2026-09-01 13:16:14

六自由度运动平台的核心原理,可以先概括为一句话:用六支可独立伸缩、又必须同步协同的执行器,改变动平台相对于固定基座的位置和姿态,从而实现三个平移自由度与三个旋转自由度。

这里真正困难的部分,不是让六支执行器分别运动,而是把一个笛卡尔空间中的目标位姿——例如“向上移动20 mm,同时俯仰2°”——实时换算为六支执行器各自应达到的长度、速度和加速度,并在机械行程、关节摆角、驱动能力和安全边界内完成协调控制。

本文讨论的是以 Stewart 并联机构为代表的六自由度运动平台。它不同于六轴串联机械臂、VR中的六自由度追踪,也不同于夹具设计中的“六点定位原理”。如果检索“六自由度原理”是为了了解运动平台如何工作,下面这条完整链路最重要:

目标位姿 → 坐标变换 → 逆运动学解算 → 六支执行器同步运动 → 反馈与位姿验证。

六自由度运动平台的三个平移方向与三个旋转方向
图1 六自由度运动平台的三个平移方向与三个旋转方向

一、六个自由度是哪六个?

刚体在三维空间中的状态,需要三个位置变量和三个姿态变量共同描述。常见表达如下:

类型 常用符号 含义 运动平台上的直观表现
沿X轴平移 X / Surge 前后移动 平台整体前移或后移
沿Y轴平移 Y / Sway 左右移动 平台整体左移或右移
沿Z轴平移 Z / Heave 上下移动 平台升高或降低
绕X轴旋转 Roll 横滚 平台向左或向右倾斜
绕Y轴旋转 Pitch 俯仰 平台前端抬起或压低
绕Z轴旋转 Yaw 偏航 平台在水平面内转向

这组名称只是常见工程约定,不是所有项目都采用完全相同的轴向和正负方向。有些系统把X定义为左右方向,有些行业使用Surge、Sway、Heave等名称。项目开始前必须固定以下约定:

  • 基座坐标系和动平台坐标系的原点在哪里;
  • X、Y、Z轴分别指向哪里,正方向如何规定;
  • Roll、Pitch、Yaw分别绕哪一根轴旋转;
  • 姿态采用哪一种欧拉角顺序,或是否使用四元数、旋转矩阵;
  • 长度、角度、速度和加速度的单位是什么。

旋转顺序尤其不能省略。三维旋转通常不满足交换律,“先横滚再俯仰”与“先俯仰再横滚”可能得到不同姿态。只给出三个角度、不说明旋转约定,控制器就无法唯一解释目标姿态。

二、六自由度运动平台与其他“六自由度”有什么区别?

“六自由度原理”在搜索中对应多种对象。概念相同的部分是描述三维空间中的位置与姿态,但实现方式并不相同。

对象 六自由度指什么 典型实现 本文是否展开
六自由度运动平台 动平台相对基座的三平移、三旋转 六支执行器组成的并联机构
六轴机械臂 末端执行器可到达的空间位姿 多个旋转或直线关节串联
六自由度追踪 设备的位置和姿态被测量 相机、惯导、激光或融合定位
六点定位原理 工件的六个刚体自由度被约束 定位点或约束面组合

因此,“六自由度”首先是对运动状态的描述,不直接等同于某一种机械结构。六支执行器的 Stewart 平台是一种常见的六自由度实现方式,但“六支腿”也不意味着每支腿单独对应一个自由度。平台的任一平移或旋转,通常都需要多支执行器同时改变长度。

三、Stewart六自由度平台的机械结构

典型 Stewart 平台由固定基座、动平台、六支可变长度执行支链以及上下连接关节组成。六支支链分布在基座与动平台之间,形成闭环并联机构。

它的运动不是把X轴机构、Y轴机构、Z轴机构逐层叠加,而是由六支支链共同约束和驱动一个动平台:

  • 固定基座提供参考坐标系和受力基础;
  • 动平台承载被测对象、模拟载荷或其他上装;
  • 六支执行器根据解算结果伸长或缩短;
  • 两端关节允许支链随平台姿态变化而调整方向;
  • 控制系统使六轴在时间上保持同步,并处理限位、状态和故障。

这种并联结构与串联机构的关键区别,在于各支链共同作用于同一个动平台。其潜在优势和实际限制都来自这种强耦合:载荷可由多条支链共同承担,但平台在笛卡尔空间中的运动范围、速度、受力和精度也不能简单按单根执行器指标直接推算。

四、理解原理的关键:六自由度运动实现链

为了避免只看到“六根电缸同步伸缩”而忽略系统本质,可以把六自由度平台拆成五层:

1. 位姿层:系统想让平台到哪里

上位机、运动脚本或实时仿真程序给出目标位姿,通常可表示为:

x = [X, Y, Z, Roll, Pitch, Yaw]ᵀ

这六个量描述动平台相对于基座的位置与姿态。若系统还要按指定轨迹运动,指令中还会涉及时间、速度、加速度、滤波或插补要求。

2. 几何层:平台和六个连接点如何定义

  • 建立固定基座坐标系B和动平台坐标系P,并记录:
  • 第i个基座连接点在B系中的坐标 bᵢ;
  • 第i个动平台连接点在P系中的坐标 pᵢ;
  • 动平台目标平移向量 t;
  • 从P系旋转到B系的旋转矩阵 R。

平台几何参数、初始高度、连接点分布和关节形式会共同决定可达空间与运动特性。这也是为什么两套都被称为“六自由度平台”的设备,工作空间和动态表现可能完全不同。

3. 解算层:把平台位姿换算成六条支链长度

对第i条支链,动平台连接点转换到基座坐标系后为:

qᵢ = t + R·pᵢ

支链向量为:

lᵢ = qᵢ − bᵢ

所需支链长度为:

Lᵢ = ‖t + R·pᵢ − bᵢ‖

对六条支链分别计算,就得到目标位姿对应的六个长度指令。这一步称为逆运动学:已知平台位姿,求执行器长度。对典型 Stewart 机构,逆运动学通常可以直接计算,因此特别适合把连续的位姿轨迹转换为实时轴指令。

4. 执行层:六轴如何按同一时间基准运动

  • 逆运动学给出的只是几何目标。控制器还要把长度轨迹转换为各轴的电机或执行器指令,并处理:
  • 多轴同步与轨迹插补;
  • 单轴位置、速度或电流等控制环;
  • 编码器或其他轴侧反馈;
  • 行程、速度、加速度和关节摆角限制;
  • 驱动器、通信和传感器状态;
  • 停机、限位和故障响应逻辑。

如果六支执行器没有在同一时基下协调,即使每个单轴最终都到达目标长度,平台在过渡过程中仍可能出现非预期姿态或瞬时误差。

5. 验证层:平台是否真的到达了目标位姿

工程上至少要区分三种“位姿”:

  • 指令位姿:控制系统要求平台达到的位置和姿态;
  • 估算位姿:由六支执行器长度通过正运动学计算得到的位姿;
  • 外部实测位姿:由激光跟踪、光学测量、惯导或其他外部系统测得的真实平台运动。

三者不能自动画等号。执行器编码器通常首先反映电机或支链位置;机械间隙、结构变形、装配误差、负载变化和传感器误差仍可能使平台真实位姿与理论值存在差异。是否需要外部测量闭环,要根据项目对精度、动态响应、可追溯性和成本的要求决定。

六自由度运动平台从目标位姿到位姿验证的五层实现链
图2 六自由度运动平台从目标位姿到位姿验证的五层实现链

五、逆运动学、正运动学和雅可比矩阵分别解决什么问题?

逆运动学:从平台位姿求六条支链长度

这是六自由度平台实时控制中最常见的解算方向。输入是目标位置和姿态,输出是六支执行器的目标长度。前文公式就是其基本几何关系。

但“公式能算出长度”不代表该位姿一定可执行。解算后还要检查:

  • 六支执行器是否都在允许行程内;
  • 上下关节是否超过允许摆角;
  • 支链、平台、载荷和周边结构是否可能干涉;
  • 所需速度和加速度是否超出轴侧约束;
  • 当前载荷与姿态下,驱动和结构能力是否满足要求;
  • 轨迹是否进入或接近奇异区域。

正运动学:从六条支链长度反求平台位姿

正运动学输入六个支链长度,求动平台的位置和姿态。与逆运动学相比,它通常更复杂,可能存在多个数学解,并常采用迭代方法从一个初始估计逐步逼近结果。

正运动学可用于状态估算、界面显示、标定、故障分析和外部测量对比。迭代是否稳定、初值是否合理、机构几何是否准确,都会影响结果。

更深入的正逆运动学推导,可继续阅读:六自由度平台正逆运动学:从位姿到支链长度的完整解算

雅可比矩阵:连接平台速度与六条支链速度

当平台位姿发生一个很小的变化时,六条支链长度也会发生相应变化。雅可比矩阵描述两者在局部范围内的映射关系,可概念性写为:

L̇ = J(x)·ẋ

其中,ẋ表示平台的线速度与角速度组合,L̇表示六条支链的长度变化速度。雅可比矩阵会随平台位姿改变,因此同样大小的笛卡尔空间速度,在不同姿态下可能对应完全不同的单轴速度和受力需求。

六、为什么六自由度平台会出现工作空间耦合和奇异位形?

六自由度平台的“工作空间”不是六个彼此独立的最大行程简单相加,也通常不是规则长方体。它由执行器行程、连接点几何、关节摆角、结构干涉、载荷、速度及控制约束共同决定。

例如:

  • 平台处于中性姿态时可能有较大的Z向可用行程;
  • 当平台同时横滚和俯仰后,部分执行器已经接近行程或关节边界,剩余平移空间会缩小;
  • 同一个X向位移,在不同Z高度和姿态下可能需要不同的支链长度组合;
  • 静态可达不等于按指定速度、加速度和载荷动态可达。

因此,平台能力应以指定载荷、重心、姿态和运动轨迹下的组合工况评价,而不是分别比较六个方向的孤立最大值。

奇异位形则是机构映射关系退化或接近退化的状态。在某些位姿附近,平台可能失去某个方向的有效约束,或者为了实现很小的平台速度,需要部分执行器产生很大的速度或受力变化。奇异性不仅是数学问题,也是工作空间规划、轨迹生成和安全边界设计必须处理的问题。

七、从目标曲线到平台运动,控制系统实际经历什么?

一个典型的控制周期可以概括为:

  1. 接收目标位姿或上位机实时数据;
  2. 完成坐标系、单位、零位和姿态表达转换;
  3. 对指令进行限幅、滤波或轨迹插补;
  4. 执行逆运动学,生成六轴目标长度;
  5. 检查行程、关节、速度、加速度和其他项目约束;
  6. 向六个驱动轴同步下发目标;
  7. 读取轴侧反馈和系统状态;
  8. 估算平台位姿,必要时与外部测量比较;
  9. 处理报警、限位、通信异常和停机条件;
  10. 进入下一个控制周期。

不同应用对这条链路的重点不同:

  • 运动模拟关注输入信号到平台运动的实时映射、滤波和运动提示算法;
  • 振动与工况复现关注目标波形、频率成分、载荷耦合及波形跟踪;
  • 精密定位关注标定、重复性、外部测量和微小运动控制;
  • 姿态补偿关注外部传感器、坐标变换、时延和闭环稳定性。

“都是六自由度平台”并不意味着控制架构、传感器配置和验收方法相同。应用任务决定了需要优化的指标,也决定了什么数据必须在方案阶段确认。

八、执行器行程为什么不能直接等同于平台行程?

这是六自由度平台选型中最常见的误解之一。

  • 单支执行器沿自身轴线伸缩,而平台的X、Y、Z、Roll、Pitch、Yaw是六条支链共同作用后的结果。两者之间经过机构几何和姿态相关的非线性映射,因此:
  • 执行器增加10 mm,不代表平台沿Z方向增加10 mm;
  • 平台做纯X向运动时,六支执行器的变化量通常不同;
  • 平台做组合姿态时,某支执行器可能先到行程边界;
  • 同一执行器速度,在不同位姿下对应的平台速度不同;
  • 单轴推力也不能脱离机构姿态直接换算为平台某方向的承载能力。

正确做法是把目标六自由度轨迹、载荷和重心输入到具体机构模型中,逐点计算六支执行器的长度、速度、加速度、受力以及关节角,并检查整个轨迹,而不是只比较产品表中的单轴参数。

九、精度从哪里来,又会在哪里损失?

六自由度平台的最终位姿性能是系统结果,不由某一个部件单独决定。主要影响因素包括:

  • 机构几何参数及其标定误差;
  • 连接关节的间隙、摩擦和装配偏差;
  • 执行器、传动和编码器的分辨率与误差;
  • 动平台、基座和支链在载荷下的弹性变形;
  • 负载质量、重心高度、惯量和安装方式;
  • 控制周期、同步误差、通信时延和控制参数;
  • 温度、振动和其他环境变化;
  • 位姿采用理论估算还是外部实测。

因此,讨论“平台精度”时要先定义测量对象和条件:是单轴重复定位、动平台某一点的位置误差、某一姿态下的角度误差,还是完整轨迹的动态跟踪误差?测量坐标系、载荷、速度、姿态范围和测量设备也应同时说明。

十、六自由度平台项目在方案阶段需要哪些输入?

仅提供“需要一台六自由度平台”还不足以完成工程选型。为了把原理转化为可验证的方案,建议至少准备以下信息:

输入类别 需要说明的内容 为什么重要
应用任务 模拟、测试、定位、补偿或其他用途 决定控制方式和验收指标
上装与载荷 质量、尺寸、安装接口、是否有人或特殊对象 影响结构、驱动和安全边界
重心与惯量 重心相对平台面的坐标、可能的变化范围 影响各支链受力和动态响应
运动范围 X/Y/Z和Roll/Pitch/Yaw的目标范围 用于机构几何与工作空间计算
组合姿态 哪些平移和旋转会同时发生 单轴极限不能代表组合可达性
动态要求 速度、加速度、频率、轨迹或时间历程 决定执行器和控制能力
精度与测量 关注的精度类型、测量方法、验收条件 避免把分辨率、重复性和绝对精度混为一谈
控制接口 指令格式、更新频率、通信方式、同步要求 决定上位机与控制系统集成方式
安装环境 空间、电源、地基、温度及周边限制 影响布置和工程实施
安全需求 限位、停机、断电状态、人员接近条件 决定风险分析和保护方案

其中,“断电后是否保持当前位置”“急停后如何停止”“制动器是否足以锁定载荷”等问题,不能只凭一个部件名称下结论。实际表现取决于驱动架构、制动方式、载荷、重力方向、机构姿态和机械保护设计,应由具体方案和风险分析确认。停止运动也不自动等于长期、独立地保持平台位姿。

十一、关于六自由度原理的常见误区

误区1:六支执行器分别控制六个自由度

事实:六个自由度是动平台的空间运动变量,六支执行器是机构坐标。两者通过逆运动学耦合映射,平台的一个自由度通常需要多支执行器协同。

误区2:六根执行器等长变化就是纯Z向运动

事实:在高度对称、装配理想且处于特定姿态的几何模型中,等量变化可能对应近似纯升降;具体系统仍取决于连接点布局、坐标定义和标定结果,不能脱离机构几何泛化。

误区3:执行器编码器闭环就是平台六自由度闭环

事实:轴侧闭环保证的是执行器或电机侧状态跟随。真实平台位姿还会受到结构、关节、负载和模型误差影响。是否形成外部笛卡尔位姿闭环,取决于有没有相应测量和控制架构。

误区4:分别满足六个方向的最大范围,就能满足组合运动

事实:工作空间是耦合且随姿态变化的。六个单方向极限通常不能同时取得,必须按目标组合轨迹验证。

误区5:只要逆运动学有解,平台就能安全执行

事实:数学可解只是第一步。还需检查行程、关节、干涉、速度、加速度、载荷、奇异性以及项目定义的安全约束。

十二、常见问题

1. Stewart平台一定有六个自由度吗?

经典 Stewart 平台通常用六条独立驱动支链控制动平台的六个刚体自由度。但具体机构也可能因结构约束、驱动数量或控制目标不同而形成不同自由度配置,判断时应看实际机构和可控变量,而不是只看外形。

2. 六自由度平台能否只做一个方向的运动?

可以。控制器可给出仅包含某一方向变化的笛卡尔指令,但六支执行器仍可能需要共同运动。能否在整个目标范围内保持“纯单自由度”,需要结合机构模型和标定结果验证。

3. 为什么正运动学比逆运动学难?

逆运动学已知平台位姿,可以直接计算各连接点之间的距离;正运动学只有六个长度,需要反求满足全部几何约束的平台位置和姿态,通常涉及非线性方程、多个可能解和迭代初值。

4. 六自由度平台的工作空间应该如何给出?

应先约定载荷、重心、初始高度、姿态范围和动态条件,再给出可达区域或指定轨迹的验证结果。只有X、Y、Z和三个角度的孤立最大值,通常不足以描述真实组合工作空间。

5. 做六自由度平台选型,最先提供什么?

优先提供应用任务、上装与载荷、重心、六自由度目标范围、组合运动、速度/加速度或目标波形、控制接口及验收方法。这些信息比先指定某个执行器型号更能决定方案方向。

十三、从“理解原理”进入项目验证

六自由度平台不是六个单轴产品的简单组合,而是一套由机构几何、运动学、执行器、实时控制、反馈测量和安全约束共同组成的系统。判断方案是否适合项目,关键不是问“有没有六自由度”,而是确认:在指定载荷和重心下,目标组合轨迹能否处于可用工作空间内,并满足动态、精度、接口和安全要求。

如果正在评估具体项目,可先整理本文第十部分的输入清单,再通过联系南京全控提交应用、载荷、运动范围、动态要求和接口信息,由技术人员基于明确工况进一步确认方案边界。也可先查看产品与应用入口技术文档栏目,继续了解相关结构与控制内容。

参考资料

  1. D. Stewart, A Platform with Six Degrees of Freedom, Proceedings of the Institution of Mechanical Engineers, 1965–1966:DOI
  2. NASA Technical Reports Server, Forward and inverse kinematics of a six degree of freedom fully parallel manipulator:NTRS 19910007810
  3. NASA Contractor Report, Development of an Intelligent Controller for a Stewart Platform:NTRS 19950019666
  4. PI,中国官网,并联运动学多轴系统:技术说明
  5. Renishaw,Six degrees of freedom (6DoF) explained:技术说明
关键词: 六自由度运动平台,Stewart平台,六自由度原理,逆运动学,正运动学
相关新闻
本网站所有内容未经授权,不得转载,违者追究相应法律责任! 法律声明