一种基于控制周期自适应时钟同步的加速度最优空间机器人在线轨迹规划方法
【专利摘要】一种基于控制周期自适应时钟同步的加速度最优空间机器人在线轨迹规划方法，本发明涉及一种基于控制周期自适应时钟同步的加速度最优空间机器人在线轨迹规划方法。本发明的目的是解决空间机器人控制中由于上下位机的时钟不同步及关节层轨迹加速度的剧烈变化引起的机器人运动过程中的不平稳问题。步骤一、建立在一个轨迹段规划周期内具有最优加速度的空间机器人关节轨迹曲线位置、速度及加速度的数学模型，并得到关节轨迹方程；步骤二、依据关节轨迹插补的连续性条件，求取步骤一中关节轨迹方程中的参数，并进行关节空间轨迹的连续规划；步骤三、在关节空间轨迹的连续规划的基础上进行同步控制。本发明应用于机器人控制领域。
【专利说明】—种基于控制周期自适应时钟同步的加速度最优空间机器人在线轨迹规划方法
【技术领域】
[0001]本发明涉及一种基于控制周期自适应时钟同步的加速度最优空间机器人在线轨迹规划方法。
【背景技术】
[0002]随着各国航天技术的发展，空间机器人在未来空间操作中的作用日益重要。空间机器人除了对硬件系统的可靠性提出严苛的要求外，对其规划与控制方法也提出了很高的要求。一般空间机器人的控制与规划相对于传统的地面机器人的难点主要在于:1)空间机器人存在很强的结构柔性，并且空间机器人载体(或基座)的自由漂浮特性使得空间机器人在运动中不仅会产生柔性抖动，而且对其载体的扰动会引起载体位姿的明显变化，从而严重影响空间机器人的位姿精度。2)空间机器人的中央控制器受其处理器运算能力及与机器人关节间通讯带宽的限制，空间机器人的控制需要采用分布式控制结构，即分为笛卡尔层和关节层，且两层具有独立的时钟周期。上述的两个难点使得空间机器人的控制与规划与地面机器人存在明显的区别。首先，空间机器人的中央控制器与机器人关节的通讯周期Λ T —般较长(如几十毫秒或几百毫秒)，即中央控制器每隔AT为机器人关节提供运行的期望位置信息等，而为了保证机器人关节运动控制的稳定性，机器人关节控制器的周期At一般较小(如几毫秒)，因此需要对中央控制器规划的期望位置信息进行关节层的再次规划。由于中央控制器和关节控制器采用2个不同时钟，因此二者需要同步，如图1所示，空间机器人的输入指令可由地面工作站通过两种输入方式提供:其一为地面预编程指令输入，即将地面离线规划完成的操作数据通过特定指令上注到在轨机器人控制器，空间机器人通过指定的时间序列完成任务操作；其二为地面遥操作设备的指令输入，即地面遥操作人员通过遥操作杆生成机器人轨迹序列，通过天地信号传输通道传输给在轨机器人控制器，完成任务操作。机器人中央控制器将地面轨迹插补为间隔AT的轨迹序列，每AT发送给机器人关节控制器，关节控制器根据本发明所提出的方法将中央控制器ΛΤ间隔的指令序列规划为At间隔的轨迹序列，输入给关节运动控制器，驱动机器人运动。其次，空间机器人关节运动的加速度会对机器人运动的平稳性产生严重影响，这也需要在空间机器人的规划中加以考虑。
【发明内容】
[0003]本发明的目的是解决空间机器人控制中由于上下位机的时钟不同步及关节层轨迹加速度的剧烈变化引起的机器人运动过程中的不平稳问题，而提供了一种基于控制周期自适应时钟同步的加速度最优空间机器人在线轨迹规划方法，
[0004]一种基于控制周期自适应时钟同步的加速度最优空间机器人在线轨迹规划方法，包括以下步骤:
[0005]步骤一、建立在一个轨迹段规划周期内具有最优加速度的空间机器人关节轨迹曲线位置、速度及加速度的数学模型，并得到关节轨迹方程；
[0006]步骤二、依据关节轨迹插补的连续性条件，求取步骤一中关节轨迹方程中的参数，并进行关节空间轨迹的连续规划；
[0007]步骤三、在关节空间轨迹的连续规划的基础上进行同步控制，即完成了一种基于控制周期自适应时钟同步的加速度最优空间机器人在线轨迹规划方法。
[0008]发明效果:
[0009]该方法保证了机器人关节加速度在整个插补周期内的最优化，通过所提出的关节控制周期自适应时钟同步机制，消除了由于上下位机的时钟不同步所导致的关节层轨迹抖动问题，大大改善了空间机器人的轨迹跟踪性能。
[0010]1、基于该方法可以实现机器人关节运动轨迹位置、速度的连续性，加速度在整个插补周期内的最优规划；
[0011]2、该方法解决了由于上下位机时钟不同步所引起的关节期望位置信息丢失而导致的关节轨迹抖动问题；
[0012]3、基于该方法设计的时钟同步机制及轨迹规划方法具有很小的计算量，方便空间机器人嵌入式系统的应用；
[0013]4、基于该方法设计的空间机器人运动轨迹可以在一定程度上降低空间机器人运行的柔性抖动，提闻空间机器人末端的跟踪精度。
【专利附图】
【附图说明】
[0014]图1是【背景技术】中的空间机器人在轨操作的控制流程示意图；
[0015]图2是步骤一和步骤二中的加速度最优的关节轨迹插补原理图；
[0016]图3是步骤三中控制周期自适应时钟同步的加速度最优轨迹规划算法执行时序及流程图；
[0017]图4是仿真对比试验中空间机器人中央控制器规划的250ms间隔的关节轨迹；其中，实线为关节期望角位置，虚线为关节期望角速度，点线为关节期望角加速度；
[0018]图5是仿真对比试验中无时钟同步控制的传统轨迹规划方法得到的关节层2ms间隔的关节轨迹，其中，实线为关节期望角位置，虚线为关节期望角速度，点线为关节期望角加速度；
[0019]图6是仿真对比试验中无时钟同步控制的加速度最优规划得到的关节层2ms间隔的关节轨迹。实线为关节期望角位置，虚线为关节期望角速度，点线为关节期望角加速度；
[0020]图7是仿真对比试验中有时钟同步控制的传统轨迹规划方法得到的关节层2ms间隔的关节轨迹。实线为关节期望角位置，虚线为关节期望角速度，点线为关节期望角加速度；
[0021]图8是仿真对比试验中有时钟同步控制的加速度最优规划得到的关节层2ms间隔的关节轨迹；实线为关节期望角位置，虚线为关节期望角速度，点线为关节期望角加速度；
[0022]图9是仿真对比试验中有时钟同步控制的规划方法在实际机器人系统中的速度响应及控制输入的比较曲线；实线为有时钟同步控制时的控制效果，虚线为无时钟同步控制时的控制效果；
[0023]图10是仿真对比试验中无时钟同步控制的规划方法在实际机器人系统中的速度响应及控制输入的比较曲线；实线为有时钟同步控制时的控制效果，虚线为无时钟同步控制时的控制效果。
【具体实施方式】
[0024]【具体实施方式】一:本实施方式的一种基于控制周期自适应时钟同步的加速度最优空间机器人在线轨迹规划方法，包括以下步骤:
[0025]步骤一、建立在一个轨迹段规划周期内具有最优加速度的空间机器人关节轨迹曲线位置、速度及加速度的数学模型，并得到关节轨迹方程；
[0026]步骤二、依据关节轨迹插补的连续性条件,求取步骤一中关节轨迹方程中的参数，并进行关节空间轨迹的连续规划；
[0027]步骤三、在关节空间轨迹的连续规划的基础上进行同步控制，即完成了一种基于控制周期自适应时钟同步的加速度最优空间机器人在线轨迹规划方法。
[0028]本实施方式效果:
[0029]该方法保证了机器人关节加速度在整个插补周期内的最优化，通过所提出的关节控制周期自适应时钟同步机制，消除了由于上下位机的时钟不同步所导致的关节层轨迹抖动问题，大大改善了空间机器人的轨迹跟踪性能。
[0030]5、基于该方法可以实现机器人关节运动轨迹位置、速度的连续性，加速度在整个插补周期内的最优规划；
[0031]6、该方法解决了由于上下位机时钟不同步所引起的关节期望位置信息丢失而导致的关节轨迹抖动问题；
[0032]7、基于该方法设计的时钟同步机制及轨迹规划方法具有很小的计算量，方便空间机器人嵌入式系统的应用；
[0033]8、基于该方法设计的空间机器人运动轨迹可以在一定程度上降低空间机器人运行的柔性抖动，提闻空间机器人末端的跟踪精度。
[0034]【具体实施方式】二:本实施方式与【具体实施方式】一不同的是:所述步骤一建立在一个轨迹段规划周期内具有最优加速度的机器人轨迹曲线位置、速度及加速度的数学模型具体为:
[0035]在一个关节轨迹规划周期tp内，若加速度最优，则选取加速度为常值，速度轨迹为时间的一次函数，位置轨迹最高次数为时间的二次函数，即:
[0036]y (t) = a0+a1t+a2t2(I)
[0037]ν(?) = y(t) = α, + 2u2t(2)
[0038]α(?)= ν(?) = 2α2(3)
[0039]其中，所述y(t)表示关节位置轨迹，a0, a1; a2表示待定的轨迹参数，t表示时间，v(t)表示关节速度轨迹，Wi)表示关节位置轨迹y(t)的一阶导数，表示关节位
置轨迹y(t)的二阶导数，a(t)表示关节加速度轨迹。
[0040]其它步骤及参数与【具体实施方式】一相同。
[0041]【具体实施方式】三:本实施方式与【具体实施方式】一或二不同的是:所述步骤二依据关节轨迹插补的连续性条件，求取步骤一中关节轨迹方程中的参数:[0042]假设在当前时刻，轨迹刚好通过A点而向B点运动，正好是B点到C点的过渡轨迹段的开始，其中，A点为关节轨迹规划初始时刻时关节的初始位置点，B和C为关节相邻时刻的期望位置点，定义，ΔΒ = A-B, AC = C-B,则由位置、速度轨迹的连续性可得:
【权利要求】
1.一种基于控制周期自适应时钟同步的加速度最优空间机器人在线轨迹规划方法，其特征在于它包括以下步骤: 步骤一、建立在一个轨迹段规划周期内具有最优加速度的空间机器人关节轨迹曲线位置、速度及加速度的数学模型，并得到关节轨迹方程； 步骤二、依据关节轨迹插补的连续性条件，求取步骤一中关节轨迹方程中的参数，并进行关节空间轨迹的连续规划； 步骤三、在关节空间轨迹的连续规划的基础上进行同步控制，即完成了一种基于控制周期自适应时钟同步的加速度最优空间机器人在线轨迹规划方法。
2.根据权利要求1所述的一种基于控制周期自适应时钟同步的加速度最优空间机器人在线轨迹规划方法，其特征在于所述步骤一建立在一个轨迹段规划周期内具有最优加速度的机器人轨迹曲线位置、速度及加速度的数学模型具体为: 在一个关节轨迹规划周期tp内，若加速度最优，则选取加速度为常值，速度轨迹为时间的一次函数，位置轨迹最高次数为时间的二次函数，即:y (t) = a0+a1t+a2t2 (I) ν(0= ν(?) = α, +2α4(2) α(?)= y(/) = 2c/2(3) 其中，所述y(t)表示关节位置轨迹,Sc^apa2表示待定的轨迹参数，t表示时间，V (t)表示关节速度轨迹，表示关节位置轨迹y(t)的一阶导数，3Ψ)表示关节位置轨迹y(t)的二阶导数，a(t)表示关节加速度轨迹。
3.根据权利要求2所述的一种基于控制周期自适应时钟同步的加速度最优空间机器人在线轨迹规划方法，其特征在于所述步骤二依据关节轨迹插补的连续性条件，求取步骤一中关节轨迹方程中的参数: 假设在当前时刻，轨迹刚好通过A点而向B点运动，正好是B点到C点的过渡轨迹段的开始，其中，A点为关节轨迹规划初始时刻时关节的初始位置点，B和C为关节相邻时刻的期望位置点，定义，Λ B = A-B, AC = C-B，则由位置、速度轨迹的连续性可得:
(―怠)=Ci0 — O1 + =B + AB
i(f -Z11) = CA；, +i/, {t,,-t^ + a2 (^, -^i) ^ ^ + ―-^ι)
tP ' 卜、_ ? t _ AB(4)
v(-r,) = O1 -2^/, = —^—
h
v(t^tl) ^ aA + 2a2 [tp -1') = 加速度方程满足: AC AB ——+—— ———=2a(5 )
tP 求解上述方程，可求得轨迹系数分别为:
4.根据权利要求3所述的一种基于控制周期自适应时钟同步的加速度最优空间机器人在线轨迹规划方法，其特征在于所述步骤三具体为: 1)在关节控制器中利用关节控制器的定时机制对中央控制器向关节发送期望位置时刻的时间间隔AT进行计时，得到关节控制器收到期望位置的时间序列为0，1，…，tk-l，tk，tk+1)…； 2)判断在某个Ttl时刻关节控制器是否启动步骤一和步骤二中所述的关节轨迹规划算法，若关节轨迹规划启动后，按照关节控制器的时钟步长每隔Λ t计算一次关节期望轨迹即调用加速度最优的轨迹规划算法输出关节期望位置、期望速度和期望加速度；若关节轨迹规划未启动，则输出关节当前位置、速度和加速度为O ; 3)判断上述步骤2)中的关节轨迹规划执行的次数是否进行了AT/At-l次，若尚没有执行Λ T/At-1次，则不作处理，依然按照关节控制器的时钟步长每隔At计算一次关节期望轨迹；若已经执行了 Λ T/At-1次，则转入步骤4)； 4)判断tk-tH与中央控制器发送期望位置的时间间隔AT的关系，若W1大于AT，则最后一次轨迹规划按照At+ε执行；若W1小于AT，则最后一次轨迹规划按照At-ε执行；若中央控制器周期等于AT，则最后一次轨迹规划At执行。
【文档编号】G05D1/08GK104020773SQ201410264716
【公开日】2014年9月3日 申请日期:2014年6月13日 优先权日:2014年6月13日
【发明者】刘业超, 夏进军, 倪风雷, 金明河 申请人:哈尔滨工业大学