会员体验
专利管家(专利管理)
工作空间(专利管理)
风险监控(情报监控)
数据分析(专利分析)
侵权分析(诉讼无效)
联系我们
交流群
官方交流:
QQ群: 891211   
微信请扫码    >>>
现在联系顾问~
首页 / 专利库 / 工业自动化和数控机床 / 自由度 / 一种7自由度机械臂系统

一种7自由度机械臂系统

阅读:934发布:2021-02-24

IPRDB可以提供一种7自由度机械臂系统专利检索,专利查询,专利分析的服务。并且本发明公开了一种7自由度机械臂系统,包括7自由度机械臂和控制模块,7自由度机械臂的任意两个相邻的电机的转动的轴线相互垂直;控制模块与7自由度机械臂连接,控制模块用于控制7自由度机械臂中的舵机的运动。7自由度机械臂包括机械臂上端部和机械臂下端部;控制模块包括机械臂上端控制部和机械臂下端控制部,机械臂上端控制部对机械臂上端部的运动进行控制,机械臂下端控制部对机械臂下端部的运动进行控制,机械臂下端控制部对械臂上端控制部进行控制。本发明通过控制模块实现了7自由度机械臂的自动化操作,使得7自由度机械臂在作业时满足平稳性高、柔性好的要求。,下面是一种7自由度机械臂系统专利的具体信息内容。

1.一种7自由度机械臂系统,其特征在于,包括7自由度机械臂和控制模块,其中,所述的7自由度机械臂的任意两个相邻的电机的转动的轴线相互垂直;

所述的控制模块与7自由度机械臂连接,控制模块用于控制7自由度机械臂中的舵机的运动。

2.根据权利要求1所述的7自由度机械臂系统,其特征在于,所述的7自由度机械臂包括机械臂上端部和机械臂下端部,机械臂上端部包括腕部俯仰舵机、机械爪、腕部旋转舵机、腕部摇摆舵机和机械爪电机,机械臂下端部包括、大臂俯仰舵机、腰部回转舵机、合金大臂、绝缘臂俯仰舵机、绝缘臂旋转舵机、绝缘臂;控制模块包括机械臂上端控制部和机械臂下端控制部,机械臂上端控制部对机械臂上端部的运动进行控制,机械臂下端控制部对机械臂下端部的运动进行控制,机械臂下端控制部对械臂上端控制部进行控制。

3.根据权利要求2所述的7自由度机械臂系统,其特征在于,所述的机械臂上端控制部和机械臂下端控制部通过无线通信方式进行连接。

4.根据权利要求3所述的7自由度机械臂系统,其特征在于,所述的7自由度机械臂系统还包括遥控模块,所述的遥控模块和机械臂下端控制部通过无线通信方式进行连接。

5.根据权利要求3所述的7自由度机械臂系统,其特征在于,所述的遥控模块包括C8051F340芯片(U3)、操作按键、触摸屏、第三无线通信电路、第三24V蓄电池和第三电源电路,其中,所述的C8051F340芯片(U3)与操作按键电连接;

所述的C8051F340芯片(U3)与触摸屏电连接;

所述的C8051F340芯片(U3)与第三无线通信电路电连接;

所述的第三24V蓄电池与第三电源电路电连接;

所述的第三电源电路对遥控模块进行供电。

6.根据权利要求2至5中任一权利要求所述的7自由度机械臂系统,其特征在于,所述的机械臂下端控制部包括C8051F340芯片(U2)、第二电源电路、第二无线通信电路、第二舵机驱动电路、第二行程限位开关电路和第二24V蓄电池,其中,所述的C8051F340芯片(U2)与第二无线通信电路电连接;

所述的C8051F340芯片(U2)与第二舵机驱动电路电连接;

所述的C8051F340芯片(U2)与第二行程限位开关电路电连接;

所述的第二无线通信电路通过无线通信方式与第三无线通信电路信号连接;

所述的第二24V蓄电池与第二电源电路电连接;

所述的第二电源电路对机械臂下端控制部供电。

7.根据权利要求6所述的7自由度机械臂系统,其特征在于,所述的机械臂上端控制部包括C8051F340芯片(U1)、第一电源电路、第一无线通信电路、第一舵机驱动电路、第一行程限位开关电路、功率驱动电路和24V蓄电池,其中,所述的C8051F340芯片(U1)与第一无线通信电路电连接;

所述的C8051F340芯片(U1)与第一舵机驱动电路电连接,第一舵机驱动电路用于驱动机械臂上端部的舵机;

所述的C8051F340芯片(U1)与第一行程限位开关电路电连接;

所述的C8051F340芯片(U1)与功率驱动电路电连接;

所述的第一无线通信电路通过无线通信方式与第二无线通信电路信号连接;

所述的第一24V蓄电池与第一电源电路电连接;

所述的第一电源电路对机械臂上端控制部供电。

8.根据权利要求7所述的7自由度机械臂系统,其特征在于,所述的第二电源电路包括电容C17、电容C19、NS6316芯片(*2)、1117-3.3芯片(P2)、电感L2、电阻R6、电阻R7、电阻R11、电容C14、电解电容C12、电容C13、电解电容C8、电容C9、电阻R4和发光二极管D2,其中,所述的电容C17的一端与24V蓄电池的电源输出端电连接;

所述的电容C17的另一端接地;

所述的电容C19的一端与24V蓄电池的电源输出端电连接;

所述的电容C19的另一端接地;

所述的24V蓄电池的电源输出端与NS6316芯片(*2)的4号引脚电连接;

所述的NS6316芯片(*2)的7号引脚接地;

所述的NS6316芯片(*2)的8号引脚接地;

所述的NS6316芯片(*2)的5号引脚与电感L2的一端电连接;

所述的NS6316芯片(*2)的6号引脚与电感L2的一端电连接;

所述的NS6316芯片(*2)的3号引脚与电感L2的另一端电连接;

所述的NS6316芯片(*2)的3号引脚与电阻R6的一端电连接;

所述的NS6316芯片(*2)的2号引脚与电阻R6的另一端电连接;

所述的NS6316芯片(*2)的2号引脚与电阻R7的一端电连接;

所述的NS6316芯片(*2)的1号引脚与电阻R7的另一端电连接;

所述的电阻R7的另一端与电阻R11的一端电连接;

所述的电阻R11的另一端接地;

所述的NS6316芯片(*2)的2号引脚作为5V输出电源端,NS6316芯片(*2)的2号引脚与电容C14的一端电连接;

所述的电容C14的另一端接地;

所述的电容C14的一端与电解电容C12的阳极电连接;

所述的电容C14的另一端与电解电容C12的阴极电连接;

所述的电容C14的一端与电容C13的一端电连接;

所述的电容C14的另一端与电容C13的另一端电连接;

所述的电容C14的一端与1117-3.3芯片(P2)的1号引脚电连接;

所述的1117-3.3芯片(P2)的2号引脚接地;

所述的1117-3.3芯片(P2)的3号引脚与电解电容C8的阳极电连接;

所述的电解电容C8的阴极接地;

所述的1117-3.3芯片(P2)的3号引脚作为3.3V输出电源端,1117-3.3芯片(P2)的3号引脚与C8051F340芯片(U2)的10号引脚电连接;

所述的1117-3.3芯片(P2)的3号引脚与电容C9的一端电连接;

所述的电容C9的另一端接地;

所述的1117-3.3芯片(P2)的3号引脚与电阻R4的一端电连接;

所述的电阻R4的另一端与发光二极管D2的阳极电连接;

所述的发光二极管D2的阴极接地。

9.根据权利要求7所述的7自由度机械臂系统,其特征在于,所述的第二无线通信电路包括nRF905芯片(*5),所述的nRF905芯片(*5)的1号引脚与1117-3.3芯片(P2)的3号引脚电连接;

所述的nRF905芯片(*5)的2号引脚与C8051F340芯片(U2)的22号引脚电连接;

所述的nRF905芯片(*5)的3号引脚与C8051F340芯片(U2)的15号引脚电连接;

所述的nRF905芯片(*5)的4号引脚与C8051F340芯片(U2)的21号引脚电连接;

所述的nRF905芯片(*5)的8号引脚与C8051F340芯片(U2)的20号引脚电连接;

所述的nRF905芯片(*5)的9号引脚与C8051F340芯片(U2)的16号引脚电连接;

所述的nRF905芯片(*5)的10号引脚与C8051F340芯片(U2)的19号引脚电连接;

所述的nRF905芯片(*5)的11号引脚与C8051F340芯片(U2)的17号引脚电连接;

所述的nRF905芯片(*5)的12号引脚与C8051F340芯片(U2)的18号引脚电连接;

所述的nRF905芯片(*5)的13号引脚接地;

所述的nRF905芯片(*5)的14号引脚接地。

10.根据权利要求7至9中任一权利要求所述的7自由度机械臂系统,其特征在于,所述的第二舵机驱动电路对大臂俯仰舵机3、腰部回转舵机4、绝缘臂俯仰舵机6、绝缘臂旋转舵机7进行驱动控制,如图4和图9所示,第二舵机驱动电路包括L298N芯片(U5)、L298N芯片(U7)、二极管D10、二极管D11、二极管D12、二极管D13、二极管D18、二极管D19、二极管D20、二极管D21、二极管D26、二极管D27、二极管D28、二极管D29、二极管D36、二极管D37、二极管D38、二极管D39、电阻R21、电阻R22、电阻R27、电阻R28,其中,所述的L298N芯片(U5)的5号引脚与C8051F340芯片(U2)的3号引脚电连接;

所述的L298N芯片(U5)的7号引脚与C8051F340芯片(U2)的4号引脚电连接;

所述的L298N芯片(U5)的10号引脚与C8051F340芯片(U2)的5号引脚电连接;

所述的L298N芯片(U5)的12号引脚与C8051F340芯片(U2)的6号引脚电连接;

所述的L298N芯片(U5)的6号引脚与C8051F340芯片(U2)的2号引脚电连接;

所述的L298N芯片(U5)的11号引脚与C8051F340芯片(U2)的1号引脚电连接;

所述的L298N芯片(U5)的8号引脚接地;

所述的L298N芯片(U5)的9号引脚与NS6316芯片(*2)的2号引脚电连接;

所述的L298N芯片(U5)的4号引脚与24V蓄电池的电源输出端电连接;

所述的L298N芯片(U5)的2号引脚与腰部回转舵机4的一端电连接;

所述的L298N芯片(U5)的2号引脚与二极管D10的阳极电连接;

所述的二极管D11的阴极接正电源;

所述的L298N芯片(U5)的2号引脚与二极管D18的阴极电连接;

所述的二极管D18的阳极接地;

所述的L298N芯片(U5)的3号引脚与腰部回转舵机4的另一端电连接;

所述的L298N芯片(U5)的3号引脚与二极管D11的阳极电连接;

所述的二极管D11的阴极接正电源;

所述的L298N芯片(U5)的3号引脚与二极管D19的阴极电连接;

所述的二极管D19的阳极接地;

所述的L298N芯片(U5)的13号引脚与大臂俯仰舵机3的一端电连接;

所述的L298N芯片(U5)的13号引脚与二极管D12的阳极电连接;

所述的二极管D12的阴极接正电源;

所述的L298N芯片(U5)的13号引脚与二极管D20的阴极电连接;

所述的二极管D20的阳极接地;

所述的L298N芯片(U5)的14号引脚与大臂俯仰舵机3的另一端电连接;

所述的L298N芯片(U5)的14号引脚与二极管D13的阳极电连接;

所述的二极管D13的阴极接正电源;

所述的L298N芯片(U5)的14号引脚与二极管D21的阴极电连接;

所述的二极管D21的阳极接地;

所述的L298N芯片(U5)的1号引脚与电阻R21的一端电连接;

所述的L298N芯片(U5)的15号引脚与电阻R22的一端电连接;

所述的电阻R21的另一端与电阻R22的另一端电连接;

所述的电阻R22的另一端接地;

所述的L298N芯片(U7)的5号引脚与C8051F340芯片(U2)的46号引脚电连接;

所述的L298N芯片(U7)的7号引脚与C8051F340芯片(U2)的45号引脚电连接;

所述的L298N芯片(U7)的10号引脚与C8051F340芯片(U2)的44号引脚电连接;

所述的L298N芯片(U7)的12号引脚与C8051F340芯片(U2)的43号引脚电连接;

所述的L298N芯片(U7)的6号引脚与C8051F340芯片(U2)的42号引脚电连接;

所述的L298N芯片(U7)的11号引脚与C8051F340芯片(U2)的41号引脚电连接;

所述的L298N芯片(U7)的8号引脚接地;

所述的L298N芯片(U7)的9号引脚与NS6316芯片(*2)的2号引脚电连接;

所述的L298N芯片(U7)的4号引脚与24V蓄电池的电源输出端电连接;

所述的L298N芯片(U7)的2号引脚与绝缘臂俯仰舵机6的一端电连接;

所述的L298N芯片(U7)的2号引脚与二极管D26的阳极电连接;

所述的二极管D26的阴极接正电源;

所述的L298N芯片(U7)的2号引脚与二极管D36的阴极电连接;

所述的二极管D36的阳极接地;

所述的L298N芯片(U7)的3号引脚与绝缘臂俯仰舵机6的另一端电连接;

所述的L298N芯片(U7)的3号引脚与二极管D27的阳极电连接;

所述的二极管D27的阴极接正电源;

所述的L298N芯片(U7)的3号引脚与二极管D37的阴极电连接;

所述的二极管D37的阳极接地;

所述的L298N芯片(U7)的13号引脚与绝缘臂旋转舵机7的一端电连接;

所述的L298N芯片(U7)的13号引脚与二极管D28的阳极电连接;

所述的二极管D28的阴极接正电源;

所述的L298N芯片(U7)的13号引脚与二极管D38的阴极电连接;

所述的二极管D38的阳极接地;

所述的L298N芯片(U7)的14号引脚与绝缘臂旋转舵机7的另一端电连接;

所述的L298N芯片(U7)的14号引脚与二极管D29的阳极电连接;

所述的二极管D29的阴极接正电源;

所述的L298N芯片(U7)的14号引脚与二极管D39的阴极电连接;

所述的二极管D39的阳极接地;

所述的L298N芯片(U5)的1号引脚与电阻R27的一端电连接;

所述的L298N芯片(U5)的15号引脚与电阻R28的一端电连接;

所述的电阻R27的另一端与电阻R28的另一端电连接;

所述的电阻R27的另一端接地。

说明书全文

一种7自由度机械臂系统

技术领域

[0001] 本发明涉及自动化机械装置领域,更具体地,涉及一种7自由度机械臂系统。

背景技术

[0002] 为提高电网络运行的安全,可靠,经济性,必须大力开展电网的带电抢修和维护作业。现有的高压带电作业机械臂,通常是专用于高压带电清扫设备的产品,具有自由度低、绝缘性能差、可扩展性差、操作性差、可移植性差等缺点。
[0003] 现有高压带电清扫设备的产品中,没有适合高压厂站和线路的高自由度轻型遥控高压带电作业机械臂,往往仅有2个自由度,操作极其不方便,不能适应电气设备多、安装密度大的复杂作业环境,往往需要对设备进行停电。
[0004] 其次,国内高压变电站户内电器设备的带电清扫大都仍停留在人工手持式清扫状态。人工带电作业使用电机驱动的大型载人机械臂,具有作业准备时间长、运行成本高等缺点,而且劳动强度大,作业艰苦,存在人身安全风险。

发明内容

[0005] 本发明克服了上述现有的技术不足,提供一种7自由度机械臂系统。
[0006] 为解决上述技术问题,本发明的技术方案如下:
[0007] 一种7自由度机械臂系统,其特征在于,包括7自由度机械臂和控制模块,其中,[0008] 所述的7自由度机械臂的任意两个相邻的电机的转动的轴线相互垂直;
[0009] 所述的控制模块与7自由度机械臂连接,控制模块用于控制7自由度机械臂中的舵机的运动。
[0010] 在一种优选的方案中,所述的7自由度机械臂包括机械臂上端部和机械臂下端部,机械臂上端部包括腕部俯仰舵机、机械爪、腕部旋转舵机、腕部摇摆舵机和机械爪电机,机械臂下端部包括、大臂俯仰舵机、腰部回转舵机、合金大臂、绝缘臂俯仰舵机、绝缘臂旋转舵机、绝缘臂;控制模块包括机械臂上端控制部和机械臂下端控制部,机械臂上端控制部对机械臂上端部的运动进行控制,机械臂下端控制部对机械臂下端部的运动进行控制,机械臂下端控制部对械臂上端控制部进行控制。
[0011] 在一种优选的方案中,所述的机械臂上端控制部和机械臂下端控制部通过无线通信方式进行连接。
[0012] 在一种优选的方案中,所述的遥控模块包括C8051F340芯片(U3)、操作按键、触摸屏、第三无线通信电路、第三24V蓄电池和第三电源电路,其中,
[0013] 所述的C8051F340芯片(U3)与操作按键电连接;
[0014] 所述的C8051F340芯片(U3)与触摸屏电连接;
[0015] 所述的C8051F340芯片(U3)与第三无线通信电路电连接;
[0016] 所述的第三24V蓄电池与第三电源电路电连接;
[0017] 所述的第三电源电路对遥控模块进行供电。
[0018] 在一种优选的方案中,所述的机械臂下端控制部包括C8051F340芯片(U2)、第二电源电路、第二无线通信电路、第二舵机驱动电路、第二行程限位开关电路和第二24V蓄电池,其中,
[0019] 所述的C8051F340芯片(U2)与第二无线通信电路电连接;
[0020] 所述的C8051F340芯片(U2)与第二舵机驱动电路电连接;
[0021] 所述的C8051F340芯片(U2)与第二行程限位开关电路电连接;
[0022] 所述的第二无线通信电路通过无线通信方式与第三无线通信电路信号连接;
[0023] 所述的第二24V蓄电池与第二电源电路电连接;
[0024] 所述的第二电源电路对机械臂下端控制部供电。
[0025] 在一种优选的方案中,所述的机械臂上端控制部包括C8051F340芯片(U1)、第一电源电路、第一无线通信电路、第一舵机驱动电路、第一行程限位开关电路、功率驱动电路和24V蓄电池,其中,
[0026] 所述的C8051F340芯片(U1)与第一无线通信电路电连接;
[0027] 所述的C8051F340芯片(U1)与第一舵机驱动电路电连接,第一舵机驱动电路用于驱动机械臂上端部的舵机;
[0028] 所述的C8051F340芯片(U1)与第一行程限位开关电路电连接;
[0029] 所述的C8051F340芯片(U1)与功率驱动电路电连接;
[0030] 所述的第一无线通信电路通过无线通信方式与第二无线通信电路信号连接;
[0031] 所述的第一24V蓄电池与第一电源电路电连接;
[0032] 所述的第一电源电路对机械臂上端控制部供电。
[0033] 在一种优选的方案中,所述的第二电源电路包括电容C17、电容C19、NS6316芯片(*2)、1117-3.3芯片(P2)、电感L2、电阻R6、电阻R7、电阻R11、电容C14、电解电容C12、电容C13、电解电容C8、电容C9、电阻R4和发光二极管D2,其中,
[0034] 所述的电容C17的一端与24V蓄电池的电源输出端电连接;
[0035] 所述的电容C17的另一端接地;
[0036] 所述的电容C19的一端与24V蓄电池的电源输出端电连接;
[0037] 所述的电容C19的另一端接地;
[0038] 所述的24V蓄电池的电源输出端与NS6316芯片(*2)的4号引脚电连接;
[0039] 所述的NS6316芯片(*2)的7号引脚接地;
[0040] 所述的NS6316芯片(*2)的8号引脚接地;
[0041] 所述的NS6316芯片(*2)的5号引脚与电感L2的一端电连接;
[0042] 所述的NS6316芯片(*2)的6号引脚与电感L2的一端电连接;
[0043] 所述的NS6316芯片(*2)的3号引脚与电感L2的另一端电连接;
[0044] 所述的NS6316芯片(*2)的3号引脚与电阻R6的一端电连接;
[0045] 所述的NS6316芯片(*2)的2号引脚与电阻R6的另一端电连接;
[0046] 所述的NS6316芯片(*2)的2号引脚与电阻R7的一端电连接;
[0047] 所述的NS6316芯片(*2)的1号引脚与电阻R7的另一端电连接;
[0048] 所述的电阻R7的另一端与电阻R11的一端电连接;
[0049] 所述的电阻R11的另一端接地;
[0050] 所述的NS6316芯片(*2)的2号引脚作为5V输出电源端,NS6316芯片(*2)的2号引脚与电容C14的一端电连接;
[0051] 所述的电容C14的另一端接地;
[0052] 所述的电容C14的一端与电解电容C12的阳极电连接;
[0053] 所述的电容C14的另一端与电解电容C12的阴极电连接;
[0054] 所述的电容C14的一端与电容C13的一端电连接;
[0055] 所述的电容C14的另一端与电容C13的另一端电连接;
[0056] 所述的电容C14的一端与1117-3.3芯片(P2)的1号引脚电连接;
[0057] 所述的1117-3.3芯片(P2)的2号引脚接地;
[0058] 所述的1117-3.3芯片(P2)的3号引脚与电解电容C8的阳极电连接;
[0059] 所述的电解电容C8的阴极接地;
[0060] 所述的1117-3.3芯片(P2)的3号引脚作为3.3V输出电源端,1117-3.3芯片(P2)的3号引脚与C8051F340芯片(U2)的10号引脚电连接;
[0061] 所述的1117-3.3芯片(P2)的3号引脚与电容C9的一端电连接;
[0062] 所述的电容C9的另一端接地;
[0063] 所述的1117-3.3芯片(P2)的3号引脚与电阻R4的一端电连接;
[0064] 所述的电阻R4的另一端与发光二极管D2的阳极电连接;
[0065] 所述的发光二极管D2的阴极接地。
[0066] 在一种优选的方案中,所述的第二无线通信电路包括nRF905芯片(*5),[0067] 所述的nRF905芯片(*5)的1号引脚与1117-3.3芯片(P2)的3号引脚电连接;
[0068] 所述的nRF905芯片(*5)的2号引脚与C8051F340芯片(U2)的22号引脚电连接;
[0069] 所述的nRF905芯片(*5)的3号引脚与C8051F340芯片(U2)的15号引脚电连接;
[0070] 所述的nRF905芯片(*5)的4号引脚与C8051F340芯片(U2)的21号引脚电连接;
[0071] 所述的nRF905芯片(*5)的8号引脚与C8051F340芯片(U2)的20号引脚电连接;
[0072] 所述的nRF905芯片(*5)的9号引脚与C8051F340芯片(U2)的16号引脚电连接;
[0073] 所述的nRF905芯片(*5)的10号引脚与C8051F340芯片(U2)的19号引脚电连接;
[0074] 所述的nRF905芯片(*5)的11号引脚与C8051F340芯片(U2)的17号引脚电连接;
[0075] 所述的nRF905芯片(*5)的12号引脚与C8051F340芯片(U2)的18号引脚电连接;
[0076] 所述的nRF905芯片(*5)的13号引脚接地;
[0077] 所述的nRF905芯片(*5)的14号引脚接地。
[0078] 在一种优选的方案中,所述的第二舵机驱动电路对大臂俯仰舵机3、腰部回转舵机4、绝缘臂俯仰舵机6、绝缘臂旋转舵机7进行驱动控制,如图4和图9所示,第二舵机驱动电路包括L298N芯片(U5)、L298N芯片(U7)、二极管D10、二极管D11、二极管D12、二极管D13、二极管D18、二极管D19、二极管D20、二极管D21、二极管D26、二极管D27、二极管D28、二极管D29、二极管D36、二极管D37、二极管D38、二极管D39、电阻R21、电阻R22、电阻R27、电阻R28,其中,[0079] 所述的L298N芯片(U5)的5号引脚与C8051F340芯片(U2)的3号引脚电连接;
[0080] 所述的L298N芯片(U5)的7号引脚与C8051F340芯片(U2)的4号引脚电连接;
[0081] 所述的L298N芯片(U5)的10号引脚与C8051F340芯片(U2)的5号引脚电连接;
[0082] 所述的L298N芯片(U5)的12号引脚与C8051F340芯片(U2)的6号引脚电连接;
[0083] 所述的L298N芯片(U5)的6号引脚与C8051F340芯片(U2)的2号引脚电连接;
[0084] 所述的L298N芯片(U5)的11号引脚与C8051F340芯片(U2)的1号引脚电连接;
[0085] 所述的L298N芯片(U5)的8号引脚接地;
[0086] 所述的L298N芯片(U5)的9号引脚与NS6316芯片(*2)的2号引脚电连接;
[0087] 所述的L298N芯片(U5)的4号引脚与24V蓄电池的电源输出端电连接;
[0088] 所述的L298N芯片(U5)的2号引脚与腰部回转舵机4的一端电连接;
[0089] 所述的L298N芯片(U5)的2号引脚与二极管D10的阳极电连接;
[0090] 所述的二极管D11的阴极接正电源;
[0091] 所述的L298N芯片(U5)的2号引脚与二极管D18的阴极电连接;
[0092] 所述的二极管D18的阳极接地;
[0093] 所述的L298N芯片(U5)的3号引脚与腰部回转舵机4的另一端电连接;
[0094] 所述的L298N芯片(U5)的3号引脚与二极管D11的阳极电连接;
[0095] 所述的二极管D11的阴极接正电源;
[0096] 所述的L298N芯片(U5)的3号引脚与二极管D19的阴极电连接;
[0097] 所述的二极管D19的阳极接地;
[0098] 所述的L298N芯片(U5)的13号引脚与大臂俯仰舵机3的一端电连接;
[0099] 所述的L298N芯片(U5)的13号引脚与二极管D12的阳极电连接;
[0100] 所述的二极管D12的阴极接正电源;
[0101] 所述的L298N芯片(U5)的13号引脚与二极管D20的阴极电连接;
[0102] 所述的二极管D20的阳极接地;
[0103] 所述的L298N芯片(U5)的14号引脚与大臂俯仰舵机3的另一端电连接;
[0104] 所述的L298N芯片(U5)的14号引脚与二极管D13的阳极电连接;
[0105] 所述的二极管D13的阴极接正电源;
[0106] 所述的L298N芯片(U5)的14号引脚与二极管D21的阴极电连接;
[0107] 所述的二极管D21的阳极接地;
[0108] 所述的L298N芯片(U5)的1号引脚与电阻R21的一端电连接;
[0109] 所述的L298N芯片(U5)的15号引脚与电阻R22的一端电连接;
[0110] 所述的电阻R21的另一端与电阻R22的另一端电连接;
[0111] 所述的电阻R22的另一端接地;
[0112] 所述的L298N芯片(U7)的5号引脚与C8051F340芯片(U2)的46号引脚电连接;
[0113] 所述的L298N芯片(U7)的7号引脚与C8051F340芯片(U2)的45号引脚电连接;
[0114] 所述的L298N芯片(U7)的10号引脚与C8051F340芯片(U2)的44号引脚电连接;
[0115] 所述的L298N芯片(U7)的12号引脚与C8051F340芯片(U2)的43号引脚电连接;
[0116] 所述的L298N芯片(U7)的6号引脚与C8051F340芯片(U2)的42号引脚电连接;
[0117] 所述的L298N芯片(U7)的11号引脚与C8051F340芯片(U2)的41号引脚电连接;
[0118] 所述的L298N芯片(U7)的8号引脚接地;
[0119] 所述的L298N芯片(U7)的9号引脚与NS6316芯片(*2)的2号引脚电连接;
[0120] 所述的L298N芯片(U7)的4号引脚与24V蓄电池的电源输出端电连接;
[0121] 所述的L298N芯片(U7)的2号引脚与绝缘臂俯仰舵机6的一端电连接;
[0122] 所述的L298N芯片(U7)的2号引脚与二极管D26的阳极电连接;
[0123] 所述的二极管D26的阴极接正电源;
[0124] 所述的L298N芯片(U7)的2号引脚与二极管D36的阴极电连接;
[0125] 所述的二极管D36的阳极接地;
[0126] 所述的L298N芯片(U7)的3号引脚与绝缘臂俯仰舵机6的另一端电连接;
[0127] 所述的L298N芯片(U7)的3号引脚与二极管D27的阳极电连接;
[0128] 所述的二极管D27的阴极接正电源;
[0129] 所述的L298N芯片(U7)的3号引脚与二极管D37的阴极电连接;
[0130] 所述的二极管D37的阳极接地;
[0131] 所述的L298N芯片(U7)的13号引脚与绝缘臂旋转舵机7的一端电连接;
[0132] 所述的L298N芯片(U7)的13号引脚与二极管D28的阳极电连接;
[0133] 所述的二极管D28的阴极接正电源;
[0134] 所述的L298N芯片(U7)的13号引脚与二极管D38的阴极电连接;
[0135] 所述的二极管D38的阳极接地;
[0136] 所述的L298N芯片(U7)的14号引脚与绝缘臂旋转舵机7的另一端电连接;
[0137] 所述的L298N芯片(U7)的14号引脚与二极管D29的阳极电连接;
[0138] 所述的二极管D29的阴极接正电源;
[0139] 所述的L298N芯片(U7)的14号引脚与二极管D39的阴极电连接;
[0140] 所述的二极管D39的阳极接地;
[0141] 所述的L298N芯片(U5)的1号引脚与电阻R27的一端电连接;
[0142] 所述的L298N芯片(U5)的15号引脚与电阻R28的一端电连接;
[0143] 所述的电阻R27的另一端与电阻R28的另一端电连接;
[0144] 所述的电阻R27的另一端接地。
[0145] 在一种优选的方案中,所述的第二行程限位开关电路对大臂俯仰舵机3、腰部回转舵机4、绝缘臂俯仰舵机6、绝缘臂旋转舵机7的运动状态进行控制,如图4和图10所示,行程限位开关电路包括4个SW-SPST开关、电阻R31、电阻R32、电阻R37、电阻R38、电阻R41、电阻R42、电阻R43、电阻R44、光电耦合器IC2、光电耦合器IC4、光电耦合器IC6和光电耦合器IC7,其中,
[0146] 所述的电阻R31的一端与NS6316芯片(*2)的2号引脚电连接;
[0147] 所述的电阻R31的一端与SW-SPST开关的一端电连接;
[0148] 所述的SW-SPST开关的另一端接地;
[0149] 所述的电阻R31的一端与光电耦合器IC2的发射级的一端电连接;
[0150] 所述的光电耦合器IC2的发射级的另一端接地;
[0151] 所述的光电耦合器IC2的接收级的一端与电阻R32的一端电连接;
[0152] 所述的电阻R32的另一端与1117-3.3芯片(P2)的3号引脚电连接;
[0153] 所述的光电耦合器IC2的接收级的一端与C8051F340芯片(U2)的48号引脚电连接;
[0154] 所述的光电耦合器IC2的接收级的另一端接地;
[0155] 所述的电阻R32的一端与NS6316芯片(*2)的2号引脚电连接;
[0156] 所述的电阻R41的一端与SW-SPST开关的一端电连接;
[0157] 所述的SW-SPST开关的另一端接地;
[0158] 所述的电阻R41的一端与光电耦合器IC6的发射级的一端电连接;
[0159] 所述的光电耦合器IC6的发射级的另一端接地;
[0160] 所述的光电耦合器IC6的接收级的一端与电阻R42的一端电连接;
[0161] 所述的电阻R42的另一端与1117-3.3芯片(P2)的3号引脚电连接;
[0162] 所述的光电耦合器IC6的接收级的一端与C8051F340芯片(U2)的32号引脚电连接;
[0163] 所述的光电耦合器IC6的接收级的另一端接地;
[0164] 所述的电阻R37的一端与NS6316芯片(*2)的2号引脚电连接;
[0165] 所述的电阻R37的一端与SW-SPST开关的一端电连接;
[0166] 所述的SW-SPST开关的另一端接地;
[0167] 所述的电阻R37的一端与光电耦合器IC4的发射级的一端电连接;
[0168] 所述的光电耦合器IC4的发射级的另一端接地;
[0169] 所述的光电耦合器IC4的接收级的一端与电阻R38的一端电连接;
[0170] 所述的电阻R38的另一端与1117-3.3芯片(P2)的3号引脚电连接;
[0171] 所述的光电耦合器IC4的接收级的一端与C8051F340芯片(U2)的40号引脚电连接;
[0172] 所述的光电耦合器IC4的接收级的另一端接地;
[0173] 所述的电阻R43的一端与NS6316芯片(*2)的2号引脚电连接;
[0174] 所述的电阻R43的一端与SW-SPST开关的一端电连接;
[0175] 所述的SW-SPST开关的另一端接地;
[0176] 所述的电阻R43的一端与光电耦合器IC47的发射级的一端电连接;
[0177] 所述的光电耦合器IC7的发射级的另一端接地;
[0178] 所述的光电耦合器IC7的接收级的一端与电阻R44的一端电连接;
[0179] 所述的电阻R44的另一端与1117-3.3芯片(P2)的3号引脚电连接;
[0180] 所述的光电耦合器IC7的接收级的一端与C8051F340芯片(U2)的24号引脚电连接;
[0181] 所述的光电耦合器IC7的接收级的另一端接地。
[0182] 在一种优选的方案中,所述的第一电源电路对机械臂上端的部件进行供电,第一电源电路包括电容C6、电容C7、NS6316芯片(*1)、1117-3.3芯片(P1)、电感L1、电阻R2、电阻R3、电阻R10、电容C5、电解电容C3、电容C4、电解电容C1、电容C2、电阻R1和发光二极管D1,其中,
[0183] 所述的电容C6的一端与24V蓄电池的电源输出端电连接;
[0184] 所述的电容C6的另一端接地;
[0185] 所述的电容C7的一端与24V蓄电池的电源输出端电连接;
[0186] 所述的电容C7的另一端接地;
[0187] 所述的24V蓄电池的电源输出端与NS6316芯片的4号引脚电连接;
[0188] 所述的NS6316芯片(*1)的7号引脚接地;
[0189] 所述的NS6316芯片(*1)的8号引脚接地;
[0190] 所述的NS6316芯片(*1)的5号引脚与电感L1的一端电连接;
[0191] 所述的NS6316芯片(*1)的6号引脚与电感L1的一端电连接;
[0192] 所述的NS6316芯片(*1)的3号引脚与电感L1的另一端电连接;
[0193] 所述的NS6316芯片(*1)的3号引脚与电阻R2的一端电连接;
[0194] 所述的NS6316芯片(*1)的2号引脚与电阻R2的另一端电连接;
[0195] 所述的NS6316芯片(*1)的2号引脚与电阻R3的一端电连接;
[0196] 所述的NS6316芯片(*1)的1号引脚与电阻R3的另一端电连接;
[0197] 所述的电阻R3的另一端与电阻R10的一端电连接;
[0198] 所述的电阻R10的另一端接地;
[0199] 所述的NS6316芯片(*1)的2号引脚作为5V输出电源端,NS6316芯片(*1)的2号引脚与电容C5的一端电连接;
[0200] 所述的电容C5的另一端接地;
[0201] 所述的电容C5的一端与电解电容C3的阳极电连接;
[0202] 所述的电容C5的另一端与电解电容C3的阴极电连接;
[0203] 所述的电容C5的一端与电容C4的一端电连接;
[0204] 所述的电容C5的另一端与电容C4的另一端电连接;
[0205] 所述的电容C5的一端与1117-3.3芯片的1号引脚电连接;
[0206] 所述的1117-3.3芯片(P1)的2号引脚接地;
[0207] 所述的1117-3.3芯片(P1)的3号引脚与电解电容C1的阳极电连接;
[0208] 所述的电解电容C1的阴极接地;
[0209] 所述的1117-3.3芯片(P1)的3号引脚作为3.3V输出电源端,1117-3.3芯片(P1)的3号引脚与C8051F340芯片(U1)的10号引脚电连接;
[0210] 所述的1117-3.3芯片(P1)的3号引脚与电容C2的一端电连接;
[0211] 所述的电容C2的另一端接地;
[0212] 所述的1117-3.3芯片(P1)的3号引脚与电阻R1的一端电连接;
[0213] 所述的电阻R1的另一端与发光二极管D1的阳极电连接;
[0214] 所述的发光二极管D1的阴极接地。
[0215] 在一种优选的方案中,所述的第一无线通信电路包括nRF905芯片(*4),其中,[0216] 所述的nRF905芯片(*4)的1号引脚与1117-3.3芯片的3号引脚电连接;
[0217] 所述的nRF905芯片(*4)的2号引脚与C8051F340芯片(U1)的22号引脚电连接;
[0218] 所述的nRF905芯片(*4)的3号引脚与C8051F340芯片(U1)的15号引脚电连接;
[0219] 所述的nRF905芯片(*4)的4号引脚与C8051F340芯片(U1)的21号引脚电连接;
[0220] 所述的nRF905芯片(*4)的8号引脚与C8051F340芯片(U1)的20号引脚电连接;
[0221] 所述的nRF905芯片(*4)的9号引脚与C8051F340芯片(U1)的16号引脚电连接;
[0222] 所述的nRF905芯片(*4)的10号引脚与C8051F340芯片(U1)的19号引脚电连接;
[0223] 所述的nRF905芯片(*4)的11号引脚与C8051F340芯片(U1)的17号引脚电连接;
[0224] 所述的nRF905芯片(*4)的12号引脚与C8051F340芯片(U1)的18号引脚电连接;
[0225] 所述的nRF905芯片(*4)的13号引脚接地;
[0226] 所述的nRF905芯片(*4)的14号引脚接地。
[0227] 在一种优选的方案中,所述的第一舵机驱动电路对腕部俯仰舵机1、机械爪电机、腕部旋转舵机10、腕部摇摆舵机12进行驱动控制,如图3和图11所示,第一舵机驱动电路包括L298N芯片(U4)、L298N芯片(U6)、二极管D6、二极管D7、二极管D8、二极管D9、二极管D14、二极管D15、二极管D16、二极管D17、二极管D22、二极管D23、二极管D24、二极管D25、二极管D32、二极管D33、二极管D34、二极管D35、电阻R19、电阻R20、电阻R25、电阻R26,其中,[0228] 所述的L298N芯片(U4)的5号引脚与C8051F340芯片(U1)的38号引脚电连接;
[0229] 所述的L298N芯片(U4)的7号引脚与C8051F340芯片(U1)的37号引脚电连接;
[0230] 所述的L298N芯片(U4)的10号引脚与C8051F340芯片(U1)的36号引脚电连接;
[0231] 所述的L298N芯片(U4)的12号引脚与C8051F340芯片(U1)的35号引脚电连接;
[0232] 所述的L298N芯片(U4)的6号引脚与C8051F340芯片(U1)的34号引脚电连接;
[0233] 所述的L298N芯片(U4)的11号引脚与C8051F340芯片(U1)的33号引脚电连接;
[0234] 所述的L298N芯片(U4)的8号引脚接地;
[0235] 所述的L298N芯片(U4)的9号引脚与NS6316芯片(*1)的2号引脚电连接;
[0236] 所述的L298N芯片(U4)的4号引脚与24V蓄电池的电源输出端电连接;
[0237] 所述的L298N芯片(U4)的2号引脚与腕部俯仰舵机1的一端电连接;
[0238] 所述的L298N芯片(U4)的2号引脚与二极管D6的阳极电连接;
[0239] 所述的二极管D6的阴极接正电源;
[0240] 所述的L298N芯片(U4)的2号引脚与二极管D14的阴极电连接;
[0241] 所述的二极管D14的阳极接地;
[0242] 所述的L298N芯片(U4)的3号引脚与腕部俯仰舵机1的另一端电连接;
[0243] 所述的L298N芯片(U4)的3号引脚与二极管D7的阳极电连接;
[0244] 所述的二极管D7的阴极接正电源;
[0245] 所述的L298N芯片(U4)的3号引脚与二极管D15的阴极电连接;
[0246] 所述的二极管D15的阳极接地;
[0247] 所述的L298N芯片(U4)的13号引脚与腕部摇摆舵机12的一端电连接;
[0248] 所述的L298N芯片(U4)的13号引脚与二极管D8的阳极电连接;
[0249] 所述的二极管D8的阴极接正电源;
[0250] 所述的L298N芯片(U4)的13号引脚与二极管D16的阴极电连接;
[0251] 所述的二极管D16的阳极接地;
[0252] 所述的L298N芯片(U4)的14号引脚与腕部摇摆舵机12的另一端电连接;
[0253] 所述的L298N芯片(U4)的14号引脚与二极管D9的阳极电连接;
[0254] 所述的二极管D9的阴极接正电源;
[0255] 所述的L298N芯片(U4)的14号引脚与二极管D17的阴极电连接;
[0256] 所述的二极管D17的阳极接地;
[0257] 所述的L298N芯片(U4)的1号引脚与电阻R20的一端电连接;
[0258] 所述的L298N芯片(U4)的15号引脚与电阻R19的一端电连接;
[0259] 所述的电阻R20的另一端与电阻R19的另一端电连接;
[0260] 所述的电阻R20的另一端接地;
[0261] 所述的L298N芯片(U6)的5号引脚与C8051F340芯片(U1)的30号引脚电连接;
[0262] 所述的L298N芯片(U6)的7号引脚与C8051F340芯片(U1)的29号引脚电连接;
[0263] 所述的L298N芯片(U6)的10号引脚与C8051F340芯片(U1)的28号引脚电连接;
[0264] 所述的L298N芯片(U6)的12号引脚与C8051F340芯片(U1)的27号引脚电连接;
[0265] 所述的L298N芯片(U6)的6号引脚与C8051F340芯片(U1)的26号引脚电连接;
[0266] 所述的L298N芯片(U6)的11号引脚与C8051F340芯片(U1)的25号引脚电连接;
[0267] 所述的L298N芯片(U6)的8号引脚接地;
[0268] 所述的L298N芯片(U6)的9号引脚与NS6316芯片(*1)的2号引脚电连接;
[0269] 所述的L298N芯片(U6)的4号引脚与24V蓄电池的电源输出端电连接;
[0270] 所述的L298N芯片(U6)的2号引脚与腕部旋转舵机10的一端电连接;
[0271] 所述的L298N芯片(U6)的2号引脚与二极管D22的阳极电连接;
[0272] 所述的二极管D22的阴极接正电源;
[0273] 所述的L298N芯片(U6)的2号引脚与二极管D32的阴极电连接;
[0274] 所述的二极管D32的阳极接地;
[0275] 所述的L298N芯片(U6)的3号引脚与腕部旋转舵机10的另一端电连接;
[0276] 所述的L298N芯片(U6)的3号引脚与二极管D23的阳极电连接;
[0277] 所述的二极管D23的阴极接正电源;
[0278] 所述的L298N芯片(U6)的3号引脚与二极管D33的阴极电连接;
[0279] 所述的二极管D33的阳极接地;
[0280] 所述的L298N芯片(U6)的13号引脚与机械爪电机的一端电连接;
[0281] 所述的L298N芯片(U6)的13号引脚与二极管D24的阳极电连接;
[0282] 所述的二极管D24的阴极接正电源;
[0283] 所述的L298N芯片(U6)的13号引脚与二极管D34的阴极电连接;
[0284] 所述的二极管D34的阳极接地;
[0285] 所述的L298N芯片(U6)的14号引脚与机械爪电机的另一端电连接;
[0286] 所述的L298N芯片(U6)的14号引脚与二极管D25的阳极电连接;
[0287] 所述的二极管D25的阴极接正电源;
[0288] 所述的L298N芯片(U6)的14号引脚与二极管D35的阴极电连接;
[0289] 所述的二极管D35的阳极接地;
[0290] 所述的L298N芯片(U4)的1号引脚与电阻R26的一端电连接;
[0291] 所述的L298N芯片(U4)的15号引脚与电阻R25的一端电连接;
[0292] 所述的电阻R25的另一端与电阻R26的另一端电连接;
[0293] 所述的电阻R26的另一端接地。
[0294] 与现有技术相比,本发明技术方案的有益效果是:
[0295] 本发明通过控制模块实现了7自由度机械臂的自动化操作,使得7自由度机械臂在作业时满足平稳性高、柔性好的要求。

附图说明

[0296] 图1为实施例1的机械结构图。
[0297] 图2为实施例1的机械机构拆分图。
[0298] 图3为实施例1的械臂上端控制部的C8051F340芯片(U1)电路图。
[0299] 图4为实施例1的械臂下端控制部的C8051F340芯片电路图。
[0300] 图5为实施例1的械臂下端控制部的第二电源电路图。
[0301] 图6为实施例1的械臂上端控制部的第一电源电路图。
[0302] 图7为实施例1的械臂下端控制部的第二无线通信电路图。
[0303] 图8为实施例1的械臂上端控制部的第一无线通信电路图。
[0304] 图9为实施例1的械臂下端控制部的第二舵机驱动电路图。
[0305] 图10为实施例1的械臂下端控制部的第二行程限位开关电路图。
[0306] 图11为实施例1的械臂上端控制部的第一舵机驱动电路图。
[0307] 图12为实施例1的械臂上端控制部的第一行程限位开关电路图。
[0308] 图13为实施例1的械臂上端控制部的功率驱动电路图。
[0309] 图14为实施例2的遥控模组的C8051F340芯片电路图。
[0310] 图15为实施例2的遥控模组的第三无线通信电路图。
[0311] 图16为实施例2遥控模组的第三电源电路图。
[0312] 图17为实施例1的控制模块的模块图。
[0313] 图18为实施例2的控制模块的模块图。
[0314] 标号说明:1、腕部俯仰舵机;2、底座;3、大臂俯仰舵机;4、腰部回转舵机;5、合金大臂;6、绝缘臂俯仰舵机;7、绝缘臂旋转舵机;8、摄像头;9、机械爪;10、腕部旋转舵机;11、绝缘臂;12、腕部摇摆舵机;13、照明灯;14、控制线孔;15、螺孔;16、主机通信模块;17、从机通信模块。

具体实施方式

[0315] 附图仅用于示例性说明,不能理解为对本专利的限制;
[0316] 为了更好说明本实施例,附图某些部件会有省略、放大或缩小,并不代表实际产品的尺寸;
[0317] 对于本领域技术人员来说,附图中某些公知结构及其说明可能省略是可以理解的。
[0318] 下面结合附图和实施例对本发明的技术方案做进一步的说明。
[0319] 实施例1
[0320] 一种7自由度机械臂系统,包括7自由度机械臂和控制模块;
[0321] 如图1和图2所示,7自由度机械臂包括机械臂上端部和机械臂下端部,机械臂下端部包括底座2、大臂俯仰舵机3、腰部回转舵机4、合金大臂5、绝缘臂俯仰舵机6、绝缘臂旋转舵机7、绝缘臂11,其中,
[0322] 绝缘臂11内部中空带有空腔;底座2设置在地面,底座的顶面与腰部回转舵机4的底面通过螺孔15进行连接,底座2的中轴线与腰部回转舵机4的轴线共线,腰部回转舵机4实现360°旋转;
[0323] 大臂俯仰舵机3与腰部回转舵机4的侧面通过螺孔15进行连接,且大臂俯仰舵机3与腰部回转舵机4相互垂直,大臂俯仰舵机3实现180°旋转;
[0324] 合金大臂5的一端与大臂俯仰舵机3的侧面通过螺孔15进行连接,且合金大臂5与大臂俯仰舵机3相互垂直;
[0325] 合金大臂5的另一端与绝缘臂俯仰舵机6的侧面通过螺孔15进行连接,且合金大臂5与绝缘臂俯仰舵机6相互垂直,绝缘臂俯仰舵机6实现360°旋转;
[0326] 绝缘臂俯仰舵机6的一端与绝缘臂旋转舵机7的一端通过螺孔15进行连接,绝缘臂旋转舵机7实现180°旋转;
[0327] 绝缘臂旋转舵机7的侧面与绝缘臂11的一端通过螺孔15进行连接,且绝缘臂旋转舵机7与绝缘臂11相互垂直。
[0328] 机械臂上端部包括腕部俯仰舵机1、摄像头8、机械爪9、腕部旋转舵机10、腕部摇摆舵机12、照明灯13和机械爪电机,其中,
[0329] 机械爪电机控制机械爪9工作;
[0330] 绝缘臂11的另一端与腕部俯仰舵机1的侧面通过螺孔15进行连接,且绝缘臂11与腕部俯仰舵机1相互垂直,腕部俯仰舵机1实现360°旋转;
[0331] 腕部俯仰舵机1的一端与腕部摇摆舵机12的侧面通过螺孔15进行连接,且腕部俯仰舵机1与腕部摇摆舵机12相互垂直,腕部摇摆舵机12实现360°旋转;
[0332] 腕部摇摆舵机12的一端与腕部旋转舵机10的侧面通过螺孔15进行连接,且腕部摇摆舵机12与腕部旋转舵机10相互垂直;
[0333] 腕部旋转舵机10的一端与机械爪9的底端通过螺孔15进行连接,且腕部旋转舵机10与机械爪9的轴线共线;
[0334] 腕部摇摆舵机12的外侧周围设置有照明灯13;
[0335] 腕部摇摆舵机12的外侧的顶端设置有摄像头8;
[0336] 合金大臂5、机械爪9、大臂俯仰舵机3、腰部回转舵机4、绝缘臂俯仰舵机6、绝缘臂旋转舵机7、腕部旋转舵机10、腕部摇摆舵机12和腕部俯仰舵机1的外侧均覆盖有符合GB/T12168标准的绝缘遮蔽罩。
[0337] 控制模块包括机械臂上端控制部和机械臂下端控制部,机械臂下端控制部对械臂上端控制部形控制,彼此是主从关系,如图17所示。
[0338] 机械臂上端控制部对机械臂上端部进行控制,机械臂上端控制部包括C8051F340芯片(U1)、第一电源电路、第一无线通信电路、第一舵机驱动电路、第一行程限位开关电路、功率驱动电路和24V蓄电池,其中,
[0339] C8051F340芯片(U1)与第一无线通信电路电连接;
[0340] C8051F340芯片(U1)与第一舵机驱动电路电连接;
[0341] C8051F340芯片(U1)与第一行程限位开关电路电连接;
[0342] C8051F340芯片(U1)与功率驱动电路电连接;
[0343] 如图3和图6所示,第一电源电路对机械臂上端的部件进行供电,第一电源电路包括电容C6、电容C7、NS6316芯片(*1)、1117-3.3芯片(P1)、电感L1、电阻R2、电阻R3、电阻R10、电容C5、电解电容C3、电容C4、电解电容C1、电容C2、电阻R1和发光二极管D1,其中,[0344] 电容C6的一端与24V蓄电池的电源输出端电连接;
[0345] 电容C6的另一端接地;
[0346] 电容C7的一端与24V蓄电池的电源输出端电连接;
[0347] 电容C7的另一端接地;
[0348] 24V蓄电池的电源输出端与NS6316芯片的4号引脚电连接;
[0349] NS6316芯片(*1)的7号引脚接地;
[0350] NS6316芯片(*1)的8号引脚接地;
[0351] NS6316芯片(*1)的5号引脚与电感L1的一端电连接;
[0352] NS6316芯片(*1)的6号引脚与电感L1的一端电连接;
[0353] NS6316芯片(*1)的3号引脚与电感L1的另一端电连接;
[0354] NS6316芯片(*1)的3号引脚与电阻R2的一端电连接;
[0355] NS6316芯片(*1)的2号引脚与电阻R2的另一端电连接;
[0356] NS6316芯片(*1)的2号引脚与电阻R3的一端电连接;
[0357] NS6316芯片(*1)的1号引脚与电阻R3的另一端电连接;
[0358] 电阻R3的另一端与电阻R10的一端电连接;
[0359] 电阻R10的另一端接地;
[0360] NS6316芯片(*1)的2号引脚作为5V输出电源端,NS6316芯片(*1)的2号引脚与电容C5的一端电连接;
[0361] 电容C5的另一端接地;
[0362] 电容C5的一端与电解电容C3的阳极电连接;
[0363] 电容C5的另一端与电解电容C3的阴极电连接;
[0364] 电容C5的一端与电容C4的一端电连接;
[0365] 电容C5的另一端与电容C4的另一端电连接;
[0366] 电容C5的一端与1117-3.3芯片的1号引脚电连接;
[0367] 1117-3.3芯片(P1)的2号引脚接地;
[0368] 1117-3.3芯片(P1)的3号引脚与电解电容C1的阳极电连接;
[0369] 电解电容C1的阴极接地;
[0370] 1117-3.3芯片(P1)的3号引脚作为3.3V输出电源端,1117-3.3芯片(P1)的3号引脚与C8051F340芯片(U1)的10号引脚电连接;
[0371] 1117-3.3芯片(P1)的3号引脚与电容C2的一端电连接;
[0372] 电容C2的另一端接地;
[0373] 1117-3.3芯片(P1)的3号引脚与电阻R1的一端电连接;
[0374] 电阻R1的另一端与发光二极管D1的阳极电连接;
[0375] 发光二极管D1的阴极接地。
[0376] 如图3和图8所示,第一无线通信电路包括nRF905芯片(*4),其中,
[0377] nRF905芯片(*4)的1号引脚与1117-3.3芯片的3号引脚电连接;
[0378] nRF905芯片(*4)的2号引脚与C8051F340芯片(U1)的22号引脚电连接;
[0379] nRF905芯片(*4)的3号引脚与C8051F340芯片(U1)的15号引脚电连接;
[0380] nRF905芯片(*4)的4号引脚与C8051F340芯片(U1)的21号引脚电连接;
[0381] nRF905芯片(*4)的8号引脚与C8051F340芯片(U1)的20号引脚电连接;
[0382] nRF905芯片(*4)的9号引脚与C8051F340芯片(U1)的16号引脚电连接;
[0383] nRF905芯片(*4)的10号引脚与C8051F340芯片(U1)的19号引脚电连接;
[0384] nRF905芯片(*4)的11号引脚与C8051F340芯片(U1)的17号引脚电连接;
[0385] nRF905芯片(*4)的12号引脚与C8051F340芯片(U1)的18号引脚电连接;
[0386] nRF905芯片(*4)的13号引脚接地;
[0387] nRF905芯片(*4)的14号引脚接地。
[0388] 第一舵机驱动电路对腕部俯仰舵机1、机械爪电机、腕部旋转舵机10、腕部摇摆舵机12进行驱动控制,如图3和图11所示,第一舵机驱动电路包括L298N芯片(U4)、L298N芯片(U6)、二极管D6、二极管D7、二极管D8、二极管D9、二极管D14、二极管D15、二极管D16、二极管D17、二极管D22、二极管D23、二极管D24、二极管D25、二极管D32、二极管D33、二极管D34、二极管D35、电阻R19、电阻R20、电阻R25、电阻R26,其中,
[0389] L298N芯片(U4)的5号引脚与C8051F340芯片(U1)的38号引脚电连接;
[0390] L298N芯片(U4)的7号引脚与C8051F340芯片(U1)的37号引脚电连接;
[0391] L298N芯片(U4)的10号引脚与C8051F340芯片(U1)的36号引脚电连接;
[0392] L298N芯片(U4)的12号引脚与C8051F340芯片(U1)的35号引脚电连接;
[0393] L298N芯片(U4)的6号引脚与C8051F340芯片(U1)的34号引脚电连接;
[0394] L298N芯片(U4)的11号引脚与C8051F340芯片(U1)的33号引脚电连接;
[0395] L298N芯片(U4)的8号引脚接地;
[0396] L298N芯片(U4)的9号引脚与NS6316芯片(*1)的2号引脚电连接;
[0397] L298N芯片(U4)的4号引脚与24V蓄电池的电源输出端电连接;
[0398] L298N芯片(U4)的2号引脚与腕部俯仰舵机1的一端电连接;
[0399] L298N芯片(U4)的2号引脚与二极管D6的阳极电连接;
[0400] 二极管D6的阴极接正电源;
[0401] L298N芯片(U4)的2号引脚与二极管D14的阴极电连接;
[0402] 二极管D14的阳极接地;
[0403] L298N芯片(U4)的3号引脚与腕部俯仰舵机1的另一端电连接;
[0404] L298N芯片(U4)的3号引脚与二极管D7的阳极电连接;
[0405] 二极管D7的阴极接正电源;
[0406] L298N芯片(U4)的3号引脚与二极管D15的阴极电连接;
[0407] 二极管D15的阳极接地;
[0408] L298N芯片(U4)的13号引脚与腕部摇摆舵机12的一端电连接;
[0409] L298N芯片(U4)的13号引脚与二极管D8的阳极电连接;
[0410] 二极管D8的阴极接正电源;
[0411] L298N芯片(U4)的13号引脚与二极管D16的阴极电连接;
[0412] 二极管D16的阳极接地;
[0413] L298N芯片(U4)的14号引脚与腕部摇摆舵机12的另一端电连接;
[0414] L298N芯片(U4)的14号引脚与二极管D9的阳极电连接;
[0415] 二极管D9的阴极接正电源;
[0416] L298N芯片(U4)的14号引脚与二极管D17的阴极电连接;
[0417] 二极管D17的阳极接地;
[0418] L298N芯片(U4)的1号引脚与电阻R20的一端电连接;
[0419] L298N芯片(U4)的15号引脚与电阻R19的一端电连接;
[0420] 电阻R20的另一端与电阻R19的另一端电连接;
[0421] 电阻R20的另一端接地;
[0422] L298N芯片(U6)的5号引脚与C8051F340芯片(U1)的30号引脚电连接;
[0423] L298N芯片(U6)的7号引脚与C8051F340芯片(U1)的29号引脚电连接;
[0424] L298N芯片(U6)的10号引脚与C8051F340芯片(U1)的28号引脚电连接;
[0425] L298N芯片(U6)的12号引脚与C8051F340芯片(U1)的27号引脚电连接;
[0426] L298N芯片(U6)的6号引脚与C8051F340芯片(U1)的26号引脚电连接;
[0427] L298N芯片(U6)的11号引脚与C8051F340芯片(U1)的25号引脚电连接;
[0428] L298N芯片(U6)的8号引脚接地;
[0429] L298N芯片(U6)的9号引脚与NS6316芯片(*1)的2号引脚电连接;
[0430] L298N芯片(U6)的4号引脚与24V蓄电池的电源输出端电连接;
[0431] L298N芯片(U6)的2号引脚与腕部旋转舵机10的一端电连接;
[0432] L298N芯片(U6)的2号引脚与二极管D22的阳极电连接;
[0433] 二极管D22的阴极接正电源;
[0434] L298N芯片(U6)的2号引脚与二极管D32的阴极电连接;
[0435] 二极管D32的阳极接地;
[0436] L298N芯片(U6)的3号引脚与腕部旋转舵机10的另一端电连接;
[0437] L298N芯片(U6)的3号引脚与二极管D23的阳极电连接;
[0438] 二极管D23的阴极接正电源;
[0439] L298N芯片(U6)的3号引脚与二极管D33的阴极电连接;
[0440] 二极管D33的阳极接地;
[0441] L298N芯片(U6)的13号引脚与机械爪电机的一端电连接;
[0442] L298N芯片(U6)的13号引脚与二极管D24的阳极电连接;
[0443] 二极管D24的阴极接正电源;
[0444] L298N芯片(U6)的13号引脚与二极管D34的阴极电连接;
[0445] 二极管D34的阳极接地;
[0446] L298N芯片(U6)的14号引脚与机械爪电机的另一端电连接;
[0447] L298N芯片(U6)的14号引脚与二极管D25的阳极电连接;
[0448] 二极管D25的阴极接正电源;
[0449] L298N芯片(U6)的14号引脚与二极管D35的阴极电连接;
[0450] 二极管D35的阳极接地;
[0451] L298N芯片(U4)的1号引脚与电阻R26的一端电连接;
[0452] L298N芯片(U4)的15号引脚与电阻R25的一端电连接;
[0453] 电阻R25的另一端与电阻R26的另一端电连接;
[0454] 电阻R26的另一端接地。
[0455] 第一行程限位开关电路对腕部俯仰舵机1、腕部旋转舵机10和腕部摇摆舵机12的运动状态进行控制,如图3和图12所示,第一行程限位开关电路包括3个SW-SPST开关、电阻R29、电阻R30、电阻R39、电阻R40、电阻R35、电阻R36、光电耦合器IC1、光电耦合器IC3、光电耦合器IC5,其中,
[0456] 电阻R29的一端与NS6316芯片(*1)的2号引脚电连接;
[0457] 电阻R29的一端与SW-SPST开关的一端电连接;
[0458] SW-SPST开关的另一端接地;
[0459] 电阻R29的一端与光电耦合器IC1的发射级的一端电连接;
[0460] 光电耦合器IC1的发射级的另一端接地;
[0461] 光电耦合器IC1的接收级的一端与电阻R30的一端电连接;
[0462] 电阻R30的另一端与1117-3.3芯片(P1)的3号引脚电连接;
[0463] 光电耦合器IC1的接收级的一端与C8051F340芯片(U1)的47号引脚电连接;
[0464] 光电耦合器IC1的接收级的另一端接地;
[0465] 电阻R99的一端与NS6316芯片的2号引脚电连接;
[0466] 电阻R39的一端与SW-SPST开关的一端电连接;
[0467] SW-SPST开关的另一端接地;
[0468] 电阻R39的一端与光电耦合器IC5的发射级的一端电连接;
[0469] 光电耦合器IC5的发射级的另一端接地;
[0470] 光电耦合器IC5的接收级的一端与电阻R40的一端电连接;
[0471] 电阻R40的另一端与1117-3.3芯片(P1)的3号引脚电连接;
[0472] 光电耦合器IC5的接收级的一端与C8051F340芯片(U1)的31号引脚电连接;
[0473] 光电耦合器IC5的接收级的另一端接地;
[0474] 电阻R35的一端与NS6316芯片(*1)的2号引脚电连接;
[0475] 电阻R35的一端与SW-SPST开关的一端电连接;
[0476] SW-SPST开关的另一端接地;
[0477] 电阻R35的一端与光电耦合器IC3的发射级的一端电连接;
[0478] 光电耦合器IC3的发射级的另一端接地;
[0479] 光电耦合器IC3的接收级的一端与电阻R30的一端电连接;
[0480] 电阻R36的另一端与1117-3.3芯片的3号引脚电连接;
[0481] 光电耦合器IC3的接收级的一端与C8051F340芯片(U1)的39号引脚电连接;
[0482] 光电耦合器IC3的接收级的另一端接地。
[0483] 功率驱动电路通过继电器对摄像头8、照明灯13和机械爪电机的电源进行控制;如图3和图13所示,功率驱动电路包括发光二极管D4、发光二极管D30、发光二极管D40、电阻R16、电阻R17、电阻R18、电阻R23、电阻R24、电阻R33、电阻R34、二极管D5、二极管D31、二极管D41、PNP三极管Q1、PNP三极管Q2、PNP三极管Q3和3个继电器,其中,
[0484] 发光二极管D4的阳极接正电源;
[0485] 发光二极管D4的阴极与电阻R16的一端电连接;
[0486] 电阻R16的另一端与二极管D5的阳极电连接;
[0487] 二极管D5的阴极接正电源;
[0488] 二极管D5的阴极与继电器的控制级的一端电连接;
[0489] 二极管D5的阳极与继电器的控制级的另一端电连接;
[0490] 二极管D5的阳极与PNP三极管Q1的发射极电连接;
[0491] PNP三极管Q1的集电极接地;
[0492] PNP三极管Q1的基极与电阻R17的一端电连接;
[0493] 电阻R17的另一端与C8051F340芯片(U1)的23号引脚电连接;
[0494] 继电器的开关级的一端与24V蓄电池的电源输出端电连接;
[0495] 继电器的开关级的另一端与照明灯13的一端电连接;
[0496] 照明灯13的另一端与电阻R18的一端电连接;
[0497] 电阻R18的另一端接地;
[0498] 发光二极管D30的阳极接正电源;
[0499] 发光二极管D30的阴极与电阻R23的一端电连接;
[0500] 电阻R23的另一端与二极管D31的阳极电连接;
[0501] 二极管D31的阴极接正电源;
[0502] 二极管D31的阴极与继电器的控制级的一端电连接;
[0503] 二极管D31的阳极与继电器的控制级的另一端电连接;
[0504] 二极管D31的阳极与PNP三极管Q2的发射极电连接;
[0505] PNP三极管Q2的集电极接地;
[0506] PNP三极管Q2的基极与电阻R24的一端电连接;
[0507] 电阻R24的另一端与C8051F340芯片(U1)的16号引脚电连接;
[0508] 继电器的开关级对摄像头8的电源进行控制;
[0509] 发光二极管D40的阳极接正电源;
[0510] 发光二极管D40的阴极与电阻R33的一端电连接;
[0511] 电阻R33的另一端与二极管D41的阳极电连接;
[0512] 二极管D41的阴极接正电源;
[0513] 二极管D41的阴极与继电器的控制级的一端电连接;
[0514] 二极管D41的阳极与继电器的控制级的另一端电连接;
[0515] 二极管D41的阳极与PNP三极管Q3的发射极电连接;
[0516] PNP三极管Q3的集电极接地;
[0517] PNP三极管Q3的基极与电阻R34的一端电连接;
[0518] 电阻R34的另一端与C8051F340芯片(U1)的15号引脚电连接;
[0519] 继电器的开关级对机械爪电机的电源进行控制。
[0520] 机械臂下端控制部对机械臂下端部进行控制,机械臂下端控制部包括C8051F340芯片(U2)、第二电源电路、第二无线通信电路、第二舵机驱动电路、第二行程限位开关电路和24V蓄电池,其中,
[0521] C8051F340芯片(U2)与第二无线通信电路电连接;
[0522] C8051F340芯片(U2)与第二舵机驱动电路电连接;
[0523] C8051F340芯片(U2)与第二行程限位开关电路电连接。
[0524] 如图4和图5所示,第二电源电路对机械臂下端的部件进行供电,电源电路包括电容C17、电容C19、NS6316芯片(*2)、1117-3.3芯片(P2)、电感L2、电阻R6、电阻R7、电阻R11、电容C14、电解电容C12、电容C13、电解电容C8、电容C9、电阻R4和发光二极管D2,其中,[0525] 电容C17的一端与24V蓄电池的电源输出端电连接;
[0526] 电容C17的另一端接地;
[0527] 电容C19的一端与24V蓄电池的电源输出端电连接;
[0528] 电容C19的另一端接地;
[0529] 24V蓄电池的电源输出端与NS6316芯片(*2)的4号引脚电连接;
[0530] NS6316芯片(*2)的7号引脚接地;
[0531] NS6316芯片(*2)的8号引脚接地;
[0532] NS6316芯片(*2)的5号引脚与电感L2的一端电连接;
[0533] NS6316芯片(*2)的6号引脚与电感L2的一端电连接;
[0534] NS6316芯片(*2)的3号引脚与电感L2的另一端电连接;
[0535] NS6316芯片(*2)的3号引脚与电阻R6的一端电连接;
[0536] NS6316芯片(*2)的2号引脚与电阻R6的另一端电连接;
[0537] NS6316芯片(*2)的2号引脚与电阻R7的一端电连接;
[0538] NS6316芯片(*2)的1号引脚与电阻R7的另一端电连接;
[0539] 电阻R7的另一端与电阻R11的一端电连接;
[0540] 电阻R11的另一端接地;
[0541] NS6316芯片(*2)的2号引脚作为5V输出电源端,NS6316芯片(*2)的2号引脚与电容C14的一端电连接;
[0542] 电容C14的另一端接地;
[0543] 电容C14的一端与电解电容C12的阳极电连接;
[0544] 电容C14的另一端与电解电容C12的阴极电连接;
[0545] 电容C14的一端与电容C13的一端电连接;
[0546] 电容C14的另一端与电容C13的另一端电连接;
[0547] 电容C14的一端与1117-3.3芯片(P2)的1号引脚电连接;
[0548] 1117-3.3芯片(P2)的2号引脚接地;
[0549] 1117-3.3芯片(P2)的3号引脚与电解电容C8的阳极电连接;
[0550] 电解电容C8的阴极接地;
[0551] 1117-3.3芯片(P2)的3号引脚作为3.3V输出电源端,1117-3.3芯片(P2)的3号引脚与C8051F340芯片(U2)的10号引脚电连接;
[0552] 1117-3.3芯片(P2)的3号引脚与电容C9的一端电连接;
[0553] 电容C9的另一端接地;
[0554] 1117-3.3芯片(P2)的3号引脚与电阻R4的一端电连接;
[0555] 电阻R4的另一端与发光二极管D2的阳极电连接;
[0556] 发光二极管D2的阴极接地。
[0557] 如图4和图7所示,第二无线通信电路包括nRF905芯片(*5),
[0558] nRF905芯片(*5)的1号引脚与1117-3.3芯片(P2)的3号引脚电连接;
[0559] nRF905芯片(*5)的2号引脚与C8051F340芯片(U2)的22号引脚电连接;
[0560] nRF905芯片(*5)的3号引脚与C8051F340芯片(U2)的15号引脚电连接;
[0561] nRF905芯片(*5)的4号引脚与C8051F340芯片(U2)的21号引脚电连接;
[0562] nRF905芯片(*5)的8号引脚与C8051F340芯片(U2)的20号引脚电连接;
[0563] nRF905芯片(*5)的9号引脚与C8051F340芯片(U2)的16号引脚电连接;
[0564] nRF905芯片(*5)的10号引脚与C8051F340芯片(U2)的19号引脚电连接;
[0565] nRF905芯片(*5)的11号引脚与C8051F340芯片(U2)的17号引脚电连接;
[0566] nRF905芯片(*5)的12号引脚与C8051F340芯片(U2)的18号引脚电连接;
[0567] nRF905芯片(*5)的13号引脚接地;
[0568] nRF905芯片(*5)的14号引脚接地。
[0569] 第二舵机驱动电路对大臂俯仰舵机3、腰部回转舵机4、绝缘臂俯仰舵机6、绝缘臂旋转舵机7进行驱动控制,如图4和图9所示,第二舵机驱动电路包括L298N芯片(U5)、L298N芯片(U7)、二极管D10、二极管D11、二极管D12、二极管D13、二极管D18、二极管D19、二极管D20、二极管D21、二极管D26、二极管D27、二极管D28、二极管D29、二极管D36、二极管D37、二极管D38、二极管D39、电阻R21、电阻R22、电阻R27、电阻R28,其中,
[0570] L298N芯片(U5)的5号引脚与C8051F340芯片(U2)的3号引脚电连接;
[0571] L298N芯片(U5)的7号引脚与C8051F340芯片(U2)的4号引脚电连接;
[0572] L298N芯片(U5)的10号引脚与C8051F340芯片(U2)的5号引脚电连接;
[0573] L298N芯片(U5)的12号引脚与C8051F340芯片(U2)的6号引脚电连接;
[0574] L298N芯片(U5)的6号引脚与C8051F340芯片(U2)的2号引脚电连接;
[0575] L298N芯片(U5)的11号引脚与C8051F340芯片(U2)的1号引脚电连接;
[0576] L298N芯片(U5)的8号引脚接地;
[0577] L298N芯片(U5)的9号引脚与NS6316芯片(*2)的2号引脚电连接;
[0578] L298N芯片(U5)的4号引脚与24V蓄电池的电源输出端电连接;
[0579] L298N芯片(U5)的2号引脚与腰部回转舵机4的一端电连接;
[0580] L298N芯片(U5)的2号引脚与二极管D10的阳极电连接;
[0581] 二极管D11的阴极接正电源;
[0582] L298N芯片(U5)的2号引脚与二极管D18的阴极电连接;
[0583] 二极管D18的阳极接地;
[0584] L298N芯片(U5)的3号引脚与腰部回转舵机4的另一端电连接;
[0585] L298N芯片(U5)的3号引脚与二极管D11的阳极电连接;
[0586] 二极管D11的阴极接正电源;
[0587] L298N芯片(U5)的3号引脚与二极管D19的阴极电连接;
[0588] 二极管D19的阳极接地;
[0589] L298N芯片(U5)的13号引脚与大臂俯仰舵机3的一端电连接;
[0590] L298N芯片(U5)的13号引脚与二极管D12的阳极电连接;
[0591] 二极管D12的阴极接正电源;
[0592] L298N芯片(U5)的13号引脚与二极管D20的阴极电连接;
[0593] 二极管D20的阳极接地;
[0594] L298N芯片(U5)的14号引脚与大臂俯仰舵机3的另一端电连接;
[0595] L298N芯片(U5)的14号引脚与二极管D13的阳极电连接;
[0596] 二极管D13的阴极接正电源;
[0597] L298N芯片(U5)的14号引脚与二极管D21的阴极电连接;
[0598] 二极管D21的阳极接地;
[0599] L298N芯片(U5)的1号引脚与电阻R21的一端电连接;
[0600] L298N芯片(U5)的15号引脚与电阻R22的一端电连接;
[0601] 电阻R21的另一端与电阻R22的另一端电连接;
[0602] 电阻R22的另一端接地;
[0603] L298N芯片(U7)的5号引脚与C8051F340芯片(U2)的46号引脚电连接;
[0604] L298N芯片(U7)的7号引脚与C8051F340芯片(U2)的45号引脚电连接;
[0605] L298N芯片(U7)的10号引脚与C8051F340芯片(U2)的44号引脚电连接;
[0606] L298N芯片(U7)的12号引脚与C8051F340芯片(U2)的43号引脚电连接;
[0607] L298N芯片(U7)的6号引脚与C8051F340芯片(U2)的42号引脚电连接;
[0608] L298N芯片(U7)的11号引脚与C8051F340芯片(U2)的41号引脚电连接;
[0609] L298N芯片(U7)的8号引脚接地;
[0610] L298N芯片(U7)的9号引脚与NS6316芯片(*2)的2号引脚电连接;
[0611] L298N芯片(U7)的4号引脚与24V蓄电池的电源输出端电连接;
[0612] L298N芯片(U7)的2号引脚与绝缘臂俯仰舵机6的一端电连接;
[0613] L298N芯片(U7)的2号引脚与二极管D26的阳极电连接;
[0614] 二极管D26的阴极接正电源;
[0615] L298N芯片(U7)的2号引脚与二极管D36的阴极电连接;
[0616] 二极管D36的阳极接地;
[0617] L298N芯片(U7)的3号引脚与绝缘臂俯仰舵机6的另一端电连接;
[0618] L298N芯片(U7)的3号引脚与二极管D27的阳极电连接;
[0619] 二极管D27的阴极接正电源;
[0620] L298N芯片(U7)的3号引脚与二极管D37的阴极电连接;
[0621] 二极管D37的阳极接地;
[0622] L298N芯片(U7)的13号引脚与绝缘臂旋转舵机7的一端电连接;
[0623] L298N芯片(U7)的13号引脚与二极管D28的阳极电连接;
[0624] 二极管D28的阴极接正电源;
[0625] L298N芯片(U7)的13号引脚与二极管D38的阴极电连接;
[0626] 二极管D38的阳极接地;
[0627] L298N芯片(U7)的14号引脚与绝缘臂旋转舵机7的另一端电连接;
[0628] L298N芯片(U7)的14号引脚与二极管D29的阳极电连接;
[0629] 二极管D29的阴极接正电源;
[0630] L298N芯片(U7)的14号引脚与二极管D39的阴极电连接;
[0631] 二极管D39的阳极接地;
[0632] L298N芯片(U5)的1号引脚与电阻R27的一端电连接;
[0633] L298N芯片(U5)的15号引脚与电阻R28的一端电连接;
[0634] 电阻R27的另一端与电阻R28的另一端电连接;
[0635] 电阻R27的另一端接地。
[0636] 第二行程限位开关电路对大臂俯仰舵机3、腰部回转舵机4、绝缘臂俯仰舵机6、绝缘臂旋转舵机7的运动状态进行控制,如图4和图10所示,行程限位开关电路包括4个SW-SPST开关、电阻R31、电阻R32、电阻R37、电阻R38、电阻R41、电阻R42、电阻R43、电阻R44、光电耦合器IC2、光电耦合器IC4、光电耦合器IC6和光电耦合器IC7,其中,
[0637] 电阻R31的一端与NS6316芯片(*2)的2号引脚电连接;
[0638] 电阻R31的一端与SW-SPST开关的一端电连接;
[0639] SW-SPST开关的另一端接地;
[0640] 电阻R31的一端与光电耦合器IC2的发射级的一端电连接;
[0641] 光电耦合器IC2的发射级的另一端接地;
[0642] 光电耦合器IC2的接收级的一端与电阻R32的一端电连接;
[0643] 电阻R32的另一端与1117-3.3芯片(P2)的3号引脚电连接;
[0644] 光电耦合器IC2的接收级的一端与C8051F340芯片(U2)的48号引脚电连接;
[0645] 光电耦合器IC2的接收级的另一端接地;
[0646] 电阻R32的一端与NS6316芯片(*2)的2号引脚电连接;
[0647] 电阻R41的一端与SW-SPST开关的一端电连接;
[0648] SW-SPST开关的另一端接地;
[0649] 电阻R41的一端与光电耦合器IC6的发射级的一端电连接;
[0650] 光电耦合器IC6的发射级的另一端接地;
[0651] 光电耦合器IC6的接收级的一端与电阻R42的一端电连接;
[0652] 电阻R42的另一端与1117-3.3芯片(P2)的3号引脚电连接;
[0653] 光电耦合器IC6的接收级的一端与C8051F340芯片(U2)的32号引脚电连接;
[0654] 光电耦合器IC6的接收级的另一端接地;
[0655] 电阻R37的一端与NS6316芯片(*2)的2号引脚电连接;
[0656] 电阻R37的一端与SW-SPST开关的一端电连接;
[0657] SW-SPST开关的另一端接地;
[0658] 电阻R37的一端与光电耦合器IC4的发射级的一端电连接;
[0659] 光电耦合器IC4的发射级的另一端接地;
[0660] 光电耦合器IC4的接收级的一端与电阻R38的一端电连接;
[0661] 电阻R38的另一端与1117-3.3芯片(P2)的3号引脚电连接;
[0662] 光电耦合器IC4的接收级的一端与C8051F340芯片(U2)的40号引脚电连接;
[0663] 光电耦合器IC4的接收级的另一端接地;
[0664] 电阻R43的一端与NS6316芯片(*2)的2号引脚电连接;
[0665] 电阻R43的一端与SW-SPST开关的一端电连接;
[0666] SW-SPST开关的另一端接地;
[0667] 电阻R43的一端与光电耦合器IC47的发射级的一端电连接;
[0668] 光电耦合器IC7的发射级的另一端接地;
[0669] 光电耦合器IC7的接收级的一端与电阻R44的一端电连接;
[0670] 电阻R44的另一端与1117-3.3芯片(P2)的3号引脚电连接;
[0671] 光电耦合器IC7的接收级的一端与C8051F340芯片(U2)的24号引脚电连接;
[0672] 光电耦合器IC7的接收级的另一端接地。
[0673] 本实施例1过机械臂上端控制部对机械臂上端部进行控制,通过机械臂下端控制部对机械臂下端部进行控制,由于绝缘臂中空设置,机械臂上端控制部过和机械臂下端控制部通过第一无线通信电路和第二无线通信电路块进行通信,且设定为机械臂下端控制部为主,机械臂上端控制部为从,机械臂下端控制部对机械臂上端控制部形成控制。在此基础上,可以通过机械臂下端控制部的C8051F340芯片设定出整个7自由度机械臂的动作。同时,由于机械臂下端部包括中空绝缘臂,高压电流无法通过机械臂上端部流进机械臂下端部,而且可以根据实际需求更换不同绝缘性能的绝缘臂。
[0674] 实施例2
[0675] 实施例2在实施例1的基础上进行延伸,增加遥控模组,通过遥控模块远程对实施例1进行控制,如图18所示。
[0676] 遥控模块包括C8051F340芯片(U3)、操作按键、触摸屏、第三无线通信电路、24V蓄电池和第三电源电路,其中,
[0677] C8051F340芯片(U3)与操作按键电连接;
[0678] C8051F340芯片(U3)与触摸屏电连接;
[0679] C8051F340芯片(U3)与第三无线通信电路电连接。
[0680] 如图13和图15所示,第三电源电路对遥控模组进行供电,电源电路包括电容C20、电容C21、NS6316芯片(*3)、1117-3.3芯片(P3)、电感L3、电阻R8、电阻R9、电阻R12、电容C18、电解电容C15、电容C16、电解电容C10、电容C11、电阻R5和发光二极管D3,其中,[0681] 电容C20的一端与24V蓄电池的电源输出端电连接;
[0682] 电容C20的另一端接地;
[0683] 电容C21的一端与24V蓄电池的电源输出端电连接;
[0684] 电容C21的另一端接地;
[0685] 24V蓄电池的电源输出端与NS6316芯片(*3)的4号引脚电连接;
[0686] NS6316芯片(*3)的7号引脚接地;
[0687] NS6316芯片(*3)的8号引脚接地;
[0688] NS6316芯片(*3)的5号引脚与电感L3的一端电连接;
[0689] NS6316芯片(*3)的6号引脚与电感L3的一端电连接;
[0690] NS6316芯片(*3)的3号引脚与电感L3的另一端电连接;
[0691] NS6316芯片(*3)的3号引脚与电阻R8的一端电连接;
[0692] NS6316芯片(*3)的2号引脚与电阻R8的另一端电连接;
[0693] NS6316芯片(*3)的2号引脚与电阻R9的一端电连接;
[0694] NS6316芯片(*3)的1号引脚与电阻R9的另一端电连接;
[0695] 电阻R9的另一端与电阻R12的一端电连接;
[0696] 电阻R12的另一端接地;
[0697] NS6316芯片(*3)的2号引脚作为5V输出电源端,NS6316芯片(*3)的2号引脚与电容C18的一端电连接;
[0698] 电容C18的另一端接地;
[0699] 电容C18的一端与电解电容C15的阳极电连接;
[0700] 电容C18的另一端与电解电容C15的阴极电连接;
[0701] 电容C18的一端与电容C16的一端电连接;
[0702] 电容C18的另一端与电容C16的另一端电连接;
[0703] 电容C18的一端与1117-3.3芯片(P3)的1号引脚电连接;
[0704] 1117-3.3芯片(P3)的2号引脚接地;
[0705] 1117-3.3芯片(P3)的3号引脚与电解电容C10的阳极电连接;
[0706] 电解电容C10的阴极接地;
[0707] 1117-3.3芯片(P3)的3号引脚作为3.3V输出电源端,1117-3.3芯片(P3)的3号引脚与C8051F340芯片(U3)的10号引脚电连接;
[0708] 1117-3.3芯片(P3)的3号引脚与电容C11的一端电连接;
[0709] 电容C11的另一端接地;
[0710] 1117-3.3芯片(P3)的3号引脚与电阻R5的一端电连接;
[0711] 电阻R5的另一端与发光二极管D3的阳极电连接;
[0712] 发光二极管D3的阴极接地。
[0713] 如图14和图15所示,第二无线通信电路包括nRF905芯片(*6),
[0714] nRF905芯片(*6)的1号引脚与1117-3.3芯片(P3)的3号引脚电连接;
[0715] nRF905芯片(*6)的2号引脚与C8051F340芯片(U3)的22号引脚电连接;
[0716] nRF905芯片(*6)的3号引脚与C8051F340芯片(U3)的15号引脚电连接;
[0717] nRF905芯片(*6)的4号引脚与C8051F340芯片(U3)的21号引脚电连接;
[0718] nRF905芯片(*6)的8号引脚与C8051F340芯片(U3)的20号引脚电连接;
[0719] nRF905芯片(*6)的9号引脚与C8051F340芯片(U3)的16号引脚电连接;
[0720] nRF905芯片(*6)的10号引脚与C8051F340芯片(U3)的19号引脚电连接;
[0721] nRF905芯片(*6)的11号引脚与C8051F340芯片(U3)的17号引脚电连接;
[0722] nRF905芯片(*6)的12号引脚与C8051F340芯片(U3)的18号引脚电连接;
[0723] nRF905芯片(*6)的13号引脚接地;
[0724] nRF905芯片(*6)的14号引脚接地。
[0725] 本实施例2通过遥控模组对实施例2进行控制,实现了远程对实施例2的控制。工作人员通过遥控模组远程输入控制指令给机械臂下端控制部,机械臂下端控制部根据控制指令操作机械臂下端部的动作,并发出控制信号给机械臂上端控制部,机械臂上端控制部根据控制指令操作机械臂上端部的动作。
[0726] 相同或相似的标号对应相同或相似的部件;
[0727] 附图中描述位置关系的用语仅用于示例性说明,不能理解为对本专利的限制;上述的扩展方式仍然属于本专利的保护范围,而不仅仅以实施例作为本专利的限制。
[0728] 对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其它不同形式的变化或变动。这里无需也无法对所有的实施方式予以穷举。凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明权利要求的保护范围之内。
高效检索全球专利

IPRDB是专利检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询专利检索等数据服务功能的知识产权数据服务商。

我们的产品包含105个国家的1.26亿组数据,专利查询、专利分析

电话:13651749426

侵权分析

IPRDB的侵权分析产品是IPRDB结合多位一线专利维权律师和专利侵权分析师的智慧,开发出来的一款特色产品,也是市面上唯一一款帮助企业研发人员、科研工作者、专利律师、专利分析师快速定位侵权分析的产品,极大的减少了用户重复工作量,提升工作效率,降低无效或侵权分析的准入门槛。

立即试用