[发明专利]花样滑冰捻转托举保护装置的控制方法

说明书

本发明提供一种花样滑冰捻转托举保护装置的控制方法，训练者正常训练时，编码器检测到绳索长度在设定的允许范围内，竖直绳索驱动电动机仅工作在力闭环，产生恒定的向上绳索牵引力；当训练者意外下落距离冰面一定高度时，即跌倒时，位置编码器检测到绳索长度超出设定范围值，竖直绳索驱动电动机切换至位置闭环，使得竖直绳索按斜坡规律停止下放，提供足够的、向上的缓冲提升力，避免人的意外摔伤。

技术领域

本发明涉及一种花样滑冰捻转托举保护装置的控制方法，以花样滑冰“捻转托举动作”保护装置为控制对象。

背景技术

绳索牵引并联机器人是20世纪80年代发展起来的一种新型机器人。它以工作空间大、运动速度快、承载能力强、轻便灵活等优点，广泛的应用于物料搬运、工业加工、虚拟实现、风洞支撑、天文观测、医学康复治疗等领域。但是在花样滑冰方面暂无先例，对于装置的控制方法也较为贫乏。

发明内容

本发明的目的是为了提供一种花样滑冰捻转托举保护装置的控制方法。

本发明的目的是这样实现的：包括花样滑冰捻转托举保护装置，花样滑冰捻转托举保护装置包括支撑系统框架、移动平台、防止绳索打结的结构，所述支撑系统框架是三角形结构且与花样滑冰场地屋顶固定连接，支撑系统框架的三个角上还设置有力矩电机，每个力矩电机的输出端上缠绕有一号柔性绳索，所述移动平台包括三角形钢板、安装在三角形钢板上的带有编码器的竖直绳索驱动电机，竖直绳索驱动电机的输出端上缠绕有二号柔性绳索，三角形钢板的下端设置有角度传感器，三根一号柔性绳索分别绕过三角形结构上设置的过轮且端部分别与三角形钢板的三个角连接，所述二号柔性绳索的端部与防止绳索打结的结构的上端连接，防止绳索打结的结构还通过三号绳索与训练者连接，二号柔性绳索保持处于竖直方向与训练者在同一竖直线上；

(1)当角度传感器检测到二号柔性绳索与竖直方向形成的角度θ不等于0时，三个力矩电机牵引三根一号绳索使移动平台形位置闭环，移动平台保持在水平面运动且位于训练者正上方；当θ等于0时，移动平台停止移动；

(2)当编码器检测到二号绳索长度在设定的允许范围l+0.5内，竖直绳索驱动电机仅工作在力闭环，产生恒定的向上绳索牵引力，训练者处于正常训练状态，其中：l是训练者正常站立时与移动平台之间的距离；

(3)当训练者意外跌倒时，编码器检测到二号柔性绳索长度超出允许范围l+0.5，竖直绳索驱动电机由力闭环控制切换至位置闭环控制，使二号柔性绳索按斜坡规律停止下放，提供向上的缓冲提升力，避免人与冰面发生强烈碰撞。

与现有技术相比，本发明的有益效果是：本发明的目的是对于花样滑冰的“捻转托举动作”保护装置提供一种控制方法。三根绳索牵引的移动平台采用位置闭环，通过角度传感器检测绳索倾斜，支撑框架上的三个电机配合牵引平台在水平面运动，使得训练者与传感器之间的绳索始终保持竖直。移动平台上的电机采用可以互相切换的位置闭环和力闭环控制；当训练者正常训练时，编码器检测到绳索长度在设定的允许范围内，竖直绳索电动机仅工作在力闭环，产生恒定的向上绳索牵引力；当训练者意外下落距离地面一定高度时，即跌倒时，位置编码器检测到绳索长度超出设定范围值，竖直绳索驱动电动机切换至位置闭环，使得竖直绳索按斜坡规律停止下放，提供足够的、向上的缓冲提升力，避免人与冰面发生强烈碰撞，起到保护作用。

附图说明

图1是本发明进行训练时的轴测图；

图2是本发明移动平台的位置闭环框图；

图3是本发明移动平台的位置分析；

图4是本发明移动平台的X轴投影位置分析；

图5是本发明移动平台的Y轴投影位置分析；

图6是本发明电机3的力闭环框图；

图7是本发明电机3的力和位置闭环结构框图。