(19)国家知识产权局 (12)发明 专利申请 (10)申请公布号 (43)申请公布日 (21)申请 号 202210478418.8 (22)申请日 2022.05.05 (71)申请人 罗海华 地址 510000 广东省广州市番禺区大石街 富丽家园福泰园八幢204房 申请人 梁新 (72)发明人 罗海华　梁新　 (74)专利代理 机构 广东穗科知识产权代理事务 所(普通合伙) 44834 专利代理师 黄启文 (51)Int.Cl. B05B 13/04(2006.01) B25J 9/02(2006.01) B25J 9/16(2006.01) B25J 11/00(2006.01) (54)发明名称 一种遥控喷涂的控制方法及系统 (57)摘要 本发明涉及一种遥控喷涂的控制方法， 涉及 到对遥控臂、 喷涂臂的控制， 所述控制方法包括： 在遥控臂侧， 采集遥控手柄中心的坐标 （X， Y， Z） ， 以及遥控手柄的姿态ax、 ay、 az， 采集得到(X， Y， Z， ax， ay， az)后， 将其向喷涂臂实时发送； 喷涂臂 接收到所述(X， Y， Z， ax， ay， az)后， 计算Z轴滑座 电机转角； 计算得到w1、 w2、 w3、 w4、 w5、 w6后， 控制 相应电机执 行旋转动作。 权利要求书2页 说明书5页 附图3页 CN 114713421 A 2022.07.08 CN 114713421 A 1.一种遥控喷涂的控制方法， 涉及到对遥控臂、 喷涂臂的控制， 其特 征在于： 其中所述遥控臂包括遥控手柄、 前臂、 连接件、 后臂， 其中遥控手柄与前臂的一端连接， 前臂的另一端与连接件的一端连接； 连接件的另一端与后臂的一端连接； 后臂的另一端固 定设置， 作为原点； 所述喷涂臂包括喷枪组件及摆臂组件； 喷枪组件包括喷枪、 喷枪Y轴摆臂电机、 喷枪Z轴摆臂电机、 喷枪X轴摆臂电机、 喷枪固定 座和电机固定座； 喷枪Y轴摆臂电机 设置于喷枪固定座上， 其 驱动端与喷枪连接； 喷枪X轴摆 臂电机设置于电机固定座上， 其驱动端与喷枪固定座连接； 喷枪Z轴摆臂电机设置于摆臂组 件上， 其驱动端与电机固定座连接； 摆臂组件包括前摆臂、 后摆臂、 前摆臂电机、 后摆臂电机及滑座； 其中前摆臂的一端与 喷枪组件连接； 前摆臂的另一端通过前摆臂电机与后摆臂的一端转动连接； 后摆臂的另一 端通过后摆臂电机与滑座转动连接； 所述滑座通过滑轨滑动安装在一监控箱的外表面上； 监控箱的外表面上还设置有Z轴滑座电机及丝杆， Z轴滑座电机与丝杆的一端连接； 丝杆的 另一端与滑座连接； 所述控制方法包括： 在遥控臂侧， 采集遥控手柄中心的坐标(X， Y， Z)， 以及遥控手柄的姿态ax、 ay、 az， 其中 X＝L3*sin(b2+b4)； Y＝L3*cos(b2+b4)； Z＝L5*cos(b5)； ax＝a1； ay＝a2； az＝180‑(a3+b1+b2+b4)； L3＝L12+L22‑2*L1*L2* cos(b3)； b2＝arccos((L12+L32‑L22)/2*L1*L3)； 其中L3表示遥控手柄中心至原点距离； b2表示后臂与遥控手柄中心、 原点所形成的直 线之间的夹角； b4表示后臂的转角； L5表示后臂的长度； b5表示后臂上下倾角； a1表示遥控 手柄X轴摆角； a2表示遥控手柄Y轴摆角； a3表示遥控手柄Z轴与前臂之间的夹角； b1表示前 臂与遥控手柄中心、 原点所形成的直线之间的夹角； L1表示连接件、 后臂的总长度之和； L2 表示前臂的长度； b3表示前臂与连接件、 后臂所 形成的直线之间的夹角； 采集得到(X， Y， Z， ax， ay， az)后， 将其向 喷涂臂实时发送； 喷涂臂接收到所述(X， Y， Z， ax， ay， az)后， 计算Z轴滑座电机转角： w1＝KZ/P1； 计算后摆臂电机转角： w2＝C 6； 计算前摆臂电机转角： 计算喷枪Z轴摆臂电机转角： w 4＝c4＝270‑c5‑c1； 计算喷枪Y轴摆臂电机转角： w5＝ay； 计算喷枪X轴摆臂电机转角： w6＝ax； 其中K表示 放大系数； P1表示丝杆螺距；权　利　要　求　书 1/2 页 2 CN 114713421 A 2C6＝C5‑C2； C5＝arctan(KY /KX)； D1表示后摆臂的长度； D2表示前摆臂的长度； c3表示前摆臂与后摆臂之间所形成的夹 角； c4表示喷枪在 Z轴平面上与前摆臂所形成直线之间的夹角； c5表 示前摆臂 一端与后摆臂 另一端所形成的直线与竖直线之间所形成的夹角； c1表示前摆臂与前摆臂一端、 后摆臂另 一端所形成的直线之间的夹角； 计算得到w1、 w2、 w3、 w4、 w5、 w6后， 控制相应电机执行旋转动 作。 2.根据权利要求1所述的遥控喷涂的控制方法， 其特征在于： 所述b4、 b5、 a1、 a2、 a3、 b1、 b3由角度传感器采集得到 。 3.一种遥控喷涂的控制系统， 应用权利要求1 ‑2任一项所述的控制方法， 其特征在于： 包括遥控臂控制器和喷涂臂控制器； 遥控臂控制器用于采集得到(X， Y， Z， ax， ay， az)后， 将 其向喷涂臂实时发送； 喷涂臂控制器用于接收所述(X， Y， Z， ax， ay， az)后， 计算w1、 w2、 w3、 w4、 w5、 w6， 控制 相应电机执 行旋转动作。权　利　要　求　书 2/2 页 3 CN 114713421 A 3