[发明专利]变电站带电水冲洗辅冲机器人水冲洗控制方法

权利要求书

1.一种变电站带电水冲洗辅冲机器人水冲洗控制方法，其特征是：具体包括以下步骤：

步骤一：根据云台上安装的激光测距仪和监控摄像头采集距离及监控的图像得到当前机器人与绝缘子之间的相对三维坐标值，判断两者相对距离是否是安全距离，若是，进行下一步，若不是，调整云台的位置，直至该相对距离为安全距离；确定路径规划的起始状态；

步骤二：采用直线插补方式实现水冲洗垂直升降机构对绝缘子串的上下方向的自动冲洗；

步骤三：采用逐点比较法的圆弧插补方式实现水枪能够对朝向机器人一侧的绝缘子串进行清洗；

步骤四：在进行水冲洗时，通过调节水枪出水口径及出水速度，形成卡门涡街并实现对绝缘子串振动频率的调节；

所述步骤二中，具体过程为：

2-1在冲洗过程中，安装在云台和垂直升降机构上的角位移传感器、位移传感器采集得到起始时刻及终止时刻云台的旋转角度和垂直升降机构的升降高度；

2-2对于平稳运动，运动轨迹函数θ(t)至少满足四个约束条件，根据约束条件对应的约束方程唯一的确定一个三次多项式；

2-3根据该三次多项式得到运动轨迹函数的速度与加速度，将运动轨迹函数的速度与加速度代入约束方程得到三次多项式的系数，该系数确定了冲洗时间与冲洗角度的关系；

2-4根据绝缘子串的长度及三次多项式得到冲洗过程中绝缘子串的长度随时间的变化关系，对(l,d,θ₀,θ_f)进行插值，其中，θ₀,θ_f为起始点和终止点的关节角度，l为绝缘子串长度，d为车体相对于绝缘子串的距离，生成水冲洗机械臂对绝缘子串的上下方向的冲洗轨迹。

2.如权利要求1所述的水冲洗控制方法，其特征是：所述约束条件，其中两个是起始点和终止点对应的云台的旋转角度：

θ(0)＝θ₀；

θ(t_f)＝θ_f；

其中，θ₀,θ_f为起始点和终止点的关节角度。

3.如权利要求1所述的水冲洗控制方法，其特征是：所述步骤2-2中，为了满足云台运动速度的连续性要求，另外还有两个约束条件，即起始点与终止点的关节速度要求，并规定：

θ'(0)＝0；

θ'(t_f)＝0；

其中，θ′(0),θ′(t_f)为起始点和终止点的云台旋转角速度。

4.如权利要求1所述的水冲洗控制方法，其特征是：所述四个约束条件唯一的确定了一个三次多项式：

θ(t)＝a₀+a₁t+a₂t²+a₃t³(1)；

其中，θ(t)为时间参变量t时刻的云台旋转角度，a₀,a₁,a₂,a₃为待定系数。