1.基于双绳索模型的绳牵引并联机器人,其特征在于,包含:控制组件、搬运组件和至少两个动力组件;所述搬运组件用以和负载接合,以在动力组件的驱动下能够带动负载移动;
所述动力组件包括电机、接合于所述电机的卷扬机、支撑柱、接合于所述支撑柱的导向滑轮、两端分别接合于所述搬运组件和所述卷扬机的绳索;所述导向滑轮用以支撑所述绳索;
所述控制组件电连接于所述电机,用以控制所述电机转动;所述控制组件包括存储器和处理器,所述处理器被配置为执行所述存储器的计算机程序,以实现以下步骤:获取搬运组件的期望轨迹;
根据所述期望轨迹,获取动力组件的绳索的末端 的坐标;
根据所述绳索的末端 的坐标、导向滑轮的中心点 和入绳点 的坐标,以及导向滑轮的半径 ,通过滑轮—绳索模型,获取绳索接合在导向滑轮上的长度 ;其中,所述滑轮—绳索模型为:式中, 为绳索接合在导向滑轮上的长度、 为绳索在导向滑轮上的缠绕角、 为导向滑轮的半径、 为出绳角、 为入绳角、 为导向滑轮的中心点 到绳索的末端 的距离、 为入绳点 到绳索的末端 的距离;
根据所述绳索的末端 的坐标,通过悬链线模型,获取导向滑轮到负载平台之间的绳索的悬链线长度 ;其中,所述悬链线模型为:式中, 为导向滑轮到负载平台之间的绳索的悬链线长度、 为出绳点 到绳索的末端 之间的水平距离、 为出绳点 到绳索的末端 之间的垂直距离、 为出绳点 到绳索的末端 之间的绳索的质量、 为重力加速度、 为出绳点 到绳索的末端 之间的绳索张力的水平分量;
根据所述绳索接合在导向滑轮上的长度 和所述导向滑轮到负载平台之间的绳索的悬链线长度 ,获取绳索的期望长度 ;其中, ,式中, 为卷扬机输出端到导向滑轮之间的绳索的长度;
根据所述绳索的期望长度 ,获取电机的期望转速 ;
获取所述电机的实际转速 ;
根据所述期望转速和所述实际转速,通过PD控制方法进行速度的闭环控制;其中,速度闭环控制的PD控制模型为: ,式中, 为电机转速补偿、 为比例参数、 为期望转速和实际转速的差值、 为积分参数、 表示对时间进行微分、 为电机的期望转速、 为电机的实际转速、 为期望转速和实际转速的差值。
2.根据权利要求1所述的基于双绳索模型的绳牵引并联机器人,其特征在于,所述绳牵引并联机器人还包括定位系统;所述控制组件通讯连接于所述定位系统,用以通过所述定位系统获取所述搬运组件的实际位置;
所述控制组件还用以实现以下步骤:
通过所述期望轨迹获取搬运组件的期望位置,以及通过定位系统获搬运组件的实际位置;
根据所述期望位置和所述实际位置,通过滑模控制方法进行位置的闭环控制;其中,位置闭环控制的滑模控制模型为: ,式中, 为搬运组件的位置补偿、 为期望位置和实际位置的差值、 为 的导数、 为正定对角矩阵为搬运组件的期望位置、 为搬运组件的实际位置。
3.根据权利要求1所述的基于双绳索模型的绳牵引并联机器人,其特征在于,滑轮—绳索模 型以 导向 滑轮 朝向 入绳 点一 侧的 水平 端点 作 为入 绳点 ,则 : ,式中, 为入绳角、 为导向滑轮的半径、 为导向滑
轮的中心点 到绳索的末端 的距离、 为导向滑轮朝向入绳点一侧的水平端点 到绳索的末端 的距离。
4.根据权利要求1至3任意一项所述的基于双绳索模型的绳牵引并联机器人,其特征在于,根据所述绳索的期望长度 ,获取电机的期望转速 ,具体包括:根据所述绳索的期望长度 ,获取电机输出轴转过的角度 ;其中, ,式中, 为第 个动力组件的电机输出轴转过的角度、 为第 个动力组件的绳索的初始长度、为第 个动力组件的绳索的期望长度、 第 个动力组件的卷扬机的绞盘半径;
根据所述电机输出轴转过的角度 ,获取电机输出轴的期望角速度 ;
根据所述电机输出轴的角速度,获取电机输出轴的期望转速 。
5.基于双绳索模型的绳牵引并联机器人的控制方法,其特征在于,包含:获取搬运组件的期望轨迹;
根据所述期望轨迹,获取动力组件的绳索的末端 的坐标;
根据所述绳索的末端 的坐标、导向滑轮的中心点 和入绳点 的坐标,以及导向滑轮的半径 ,通过滑轮—绳索模型,获取绳索接合在导向滑轮上的长度 ;其中,所述滑轮—绳索模型为:式中, 为绳索接合在导向滑轮上的长度、 为绳索在导向滑轮上的缠绕角、 为导向滑轮的半径、 为出绳角、 为入绳角、 为导向滑轮的中心点 到绳索的末端 的距离、 为入绳点 到绳索的末端 的距离;
根据所述绳索的末端 的坐标,通过悬链线模型,获取导向滑轮到负载平台之间的绳索的悬链线长度 ;其中,所述悬链线模型为:式中, 为导向滑轮到负载平台之间的绳索的悬链线长度、 为出绳点 到绳索的末端 之间的水平距离、 为出绳点 到绳索的末端 之间的垂直距离、 为出绳点到绳索的末端 之间的绳索的质量、 为重力加速度、 为出绳点 到绳索的末端 之间的绳索张力的水平分量;
根据所述绳索接合在导向滑轮上的长度 和所述导向滑轮到负载平台之间的绳索的悬链线长度 ,获取绳索的期望长度 ;其中, ,式中, 为卷扬机输出端到导向滑轮之间的绳索的长度;
根据所述绳索的期望长度 ,获取电机的期望转速 ;
获取所述电机的实际转速 ;
根据所述期望转速和所述实际转速,通过PD控制方法进行速度的闭环控制;其中,速度闭环控制的PD控制模型为: ,式中, 为电机转速补偿、 为比例参数、 为期望转速和实际转速的差值、 为积分参数、 表示对时间进行微分、为电机的期望转速、 为电机的实际转速、 为期望转速和实际转速的差值。
6.基于双绳索模型的绳牵引并联机器人的控制装置,其特征在于,包含:轨迹获取模块,用于获取搬运组件的期望轨迹;
坐标获取模块,用于根据所述期望轨迹,获取动力组件的绳索的末端 的坐标;
第一长度获取模块,用于根据所述绳索的末端 的坐标、导向滑轮的中心点 和入绳点 的坐标,以及导向滑轮的半径 ,通过滑轮—绳索模型,获取绳索接合在导向滑轮上的长度 ;其中,所述滑轮—绳索模型为:式中, 为绳索接合在导向滑轮上的长度、 为绳索在导向滑轮上的缠绕角、 为导向滑轮的半径、 为出绳角、 为入绳角、 为导向滑轮的中心点 到绳索的末端 的距离、 为入绳点 到绳索的末端 的距离;
第二长度获取模块,用于根据所述绳索的末端 的坐标,通过悬链线模型,获取导向滑轮到负载平台之间的绳索的悬链线长度 ;其中,所述悬链线模型为:式中, 为导向滑轮到负载平台之间的绳索的悬链线长度、 为出绳点 到绳索的末端 之间的水平距离、 为出绳点 到绳索的末端 之间的垂直距离、 为出绳点到绳索的末端 之间的绳索的质量、 为重力加速度、 为出绳点 到绳索的末端 之间的绳索张力的水平分量;
第三长度模块,用于根据所述绳索接合在导向滑轮上的长度 和所述导向滑轮到负载平台之间的绳索的悬链线长度 ,获取绳索的期望长度 ;其中, ,式中, 为卷扬机输出端到导向滑轮之间的绳索的长度;
期望转速获取模块,用于根据所述绳索的期望长度 ,获取电机的期望转速 ;
实际转速获取模块,用于获取所述电机的实际转速 ;
速度控制模块,用于根据所述期望转速和所述实际转速,通过PD控制方法进行速度的闭环控制;其中,速度闭环控制的PD控制模型为: ,式中, 为电机转速补偿、 为比例参数、 为期望转速和实际转速的差值、 为积分参数、 表示对时间进行微分、 为电机的期望转速、 为电机的实际转速、 为期望转速和实际转速的差值。