基于闭环控制的机器人用精密液压驱动关节制造技术

基于闭环控制的机器人用精密液压驱动关节，包括闭环控制系统和用于机器人的转动关节，闭环控制系统包括单片机、电机驱动器、伺服电机、双向螺杆泵、摆动液压缸、以及检测摆动液压缸的输出轴的精确转动角度的电检测系统构成闭环控制系统，电检测系统包括在检测轴上安装的脉冲式旋转编码器和旋转电位器、以及细分角度检测电路，旋转电位器的转轴和脉冲式旋转编码器的动环通过弹性联轴器固定连接，通过单片机和细分角度电压检测电路检测脉冲式旋转编码器的整刻度角度外的细分角度所对应的电位器电压，进而检测出脉冲式旋转编码器的整刻度角度之外的细分角度的精确角度值，从而可高精度地驱动机器人的转动关节的转动。

【技术实现步骤摘要】

本专利技术涉及一种机器人用液压驱动关节。
技术介绍
我国的机器人企业多为加工组装，关键核心技术缺乏，机器人中的三个关键核心部件(高性能交流伺服电机、精密减速器、控制器)长期依赖进口，特别是精密减速器几乎被日本的帝人、HRAMonic两家公司所垄断，售价居高不下，直接推高了我国机器人产品的生产成本，降低了产品的市场竞争力，使我国机器人的发展只局限在加工、组装方面，并面临着产业空心化的风险。对机器人来说，转动关节要求扭矩大、回转精度高。常用的方法是采用精密机械减速装置(如谐波减速器、RV减速机等)，通过大减速比获得大扭矩，通过零件的精密制造获得高的回转精度，通过零件间的预紧获得必要的刚度。影响减速装置回转精度的主要因素是该减速装置的反向回差。减速装置的反向回差大小取决于其组成零件的加工精度、装配精度以及相互啮合零件间的预紧。高精度零件的加工和高精度的装配势必造成高制造成本，相互啮合零件间的预紧一方面增加了装配的难度，另一方面会增加零件的磨损。此外，减速装置使用一段时间后，由于相互啮合零件间啮合面的磨损将增大所述反向回差，从而导致该减速装置无法正常使用，因此，从国外进口的机器人在使用几年后，由于定位精度不够而淘汰的例子常有发生。
技术实现思路
本专利技术针对现有的机器人用转动关节的上述不足，提供一种无需采用减速装置、转角控制精度高、转动扭矩大的基于闭环控制的机器人用精密液压驱动关节。为了解决上述技术问题，本专利技术采用以下的技术方案：基于闭环控制的机器人用精密液压驱动关节，包括闭环控制系统和用于机器人的转动关节，所述闭环控制系统包括单片机、电机驱动器、伺服电机、双向螺杆泵、摆动液压缸、以及检测摆动液压缸的输出轴的精确转动角度的电检测系统；所述单片机通过所述电机驱动器控制伺服电机转动，所述伺服电机驱动所述双向螺杆泵内的螺杆正向或反向旋转，所述双向螺杆泵具有位于一侧的第一输出端和位于另一侧的第二输出端，所述摆动液压缸的内腔由叶片分隔成第一液压腔和第二液压腔，所述双向螺杆泵的第一输出端通过第一管路和摆动液压缸的第一液压腔连通，所述双向螺杆泵的第二输出端通过第二管路和摆动液压缸的第二液压腔连通，当双向螺杆泵的螺杆正向旋转时，双向螺杆泵从其第一输出端出油，推动摆动液压缸的叶片正向转动后从第二输出端回油，当双向螺杆泵的螺杆反向旋转时，双向螺杆泵从其第二输出端出油，推动摆动液压缸的叶片反向转动后从第一输出端回油，所述双向螺杆泵、第一管路、第二管路、摆动液压缸构成闭式液压系统；所述摆动液压缸的输出轴连接机器人的转动关节，摆动液压缸的输出轴还通过传动比为1:1的钢带传动机构连接一检测轴，该钢带传动机构的传动带采用没有伸缩弹性的钢材质以保证瞬时传动比为1:1，从而保证摆动液压缸的输出轴和所述检测轴的转角的瞬间一致；所述电检测系统包括套装在所述检测轴上的脉冲式旋转编码器、转轴与脉冲式旋转编码器的动环通过弹性联轴器固接的旋转电位器、用于检测脉冲式旋转编码器的整刻度角度外的细分角度所对应电位器电压的细分角度电压检测电路，所述旋转电位器的电阻体两端连接标准电平，旋转电位器的滑动端由所述转轴带动在所述电阻体上转动滑行，旋转电位器的滑动端与电阻体的电压负极之间构成Vin，所述脉冲式旋转编码器可检测其分辨率内实际转角所对应的整刻度角度，整刻度角度外的细分角度由所述旋转电位器、细分角度电压检测电路、以及单片机获得，所述细分角度电压检测电路包括用于检测脉冲式旋转编码器的整刻度角度所对应的电位器电压V(i)以及所述检测轴的实际转角所对应的电位器电压Vin的主检测电路、螺杆正向旋转时用于放大Vin与V(i)之间差值的第一差动电压放大电路、螺杆反向旋转时用于放大V(i)与Vin之间差值的第二差动电压放大电路；所述主检测电路包括电压比较器、第一电压跟随器、第二电压跟随器、第三电压跟随器、第四电压跟随器、第五电压跟随器，所述电压比较器的同向端连接由所述单片机通过D/A转换模块或PWM产生模块产生的V(i)，所述电压比较器的反相端连接第一电压跟随器的输出端，当该电压比较器的同相端电压大于反向端电压时，电压比较器的输出端输出高电平，当该电压比较器的同相端电压小于反向端电压时，电压比较器的输出端输出低电平，所述第一电压跟随器的正输入端连接所述旋转电位器的滑动端的输出电压Vin，第一电压跟随器的负输入端直接连接其输出端，所述电压比较器的同相端还连接第二电压跟随器的正输入端，第二电压跟随器的负输入端直接连接其输出端，第二电压跟随器的输出端连接第三电压跟随器的正输入端，第三电压跟随器的负输入端直接连接其输出端，所述第一电压跟随器的输出端连接第四电压跟随器的正输入端，第四电压跟随器的负输入端直接连接其输出端，第四电压跟随器的输出端连接第五电压跟随器的正输入端，第五电压跟随器的负输入端直接连接其输出端；所述脉冲式旋转编码器的每个整刻度角度对应的旋转电位器的电压值可以预先得到，并存储到所述单片机的RAM内的表格里面，具体做法是，使伺服电机驱动双向螺杆泵的螺杆转动，使摆动液压缸的输出轴转动到脉冲式旋转编码器的整刻度角度i时，使摆动液压缸停止转动，此时该整刻度角度对应的电位器电压值为Vin，然后通过单片机调节所述D/A转换模块的输入数字量或者所述PWM产生模块的占空比，产生逐渐增大的电压V(i)，所述电压比较器的输出端通过限流电阻R1连接所述单片机的普通I/O口，当单片机检测到该普通I/O口的输入端TEST从低电平0突变为高电平1时，单片机停止调节V(i)，该突变时刻的V(i)即为该整刻度角度所对应的电位器电压值，然后再将对应此整刻度角度的V(i)和对应的脉冲数i保存到单片机的RAM内的表格里，依此做法检测脉冲式旋转编码器的下一整刻度角度对应的电压V(i+1)，直到检测完脉冲式旋转编码器所有的整刻度角度对应的电压值，这样就在单片机的RAM内预先建立了脉冲式旋转编码器的所有整刻度角度对应的电压值和相应脉冲数i的表格；所述脉冲式旋转编码器的输出连接至单片机的计数器的外部输入端口，计数器采用边沿中断触发工作方式，可以捕捉正反转情况下脉冲式旋转编码器待检测相的脉冲个数，当计数器检测到第i个脉冲时，单片机从RAM内预存的表格中调出第i个脉冲对应的电位器电压V(i)，因此在计数器对脉冲的检测作用下，每当所述检测轴转到脉冲式旋转编码器的每个脉冲i的检测边沿，单片机都可以从RAM内预存的表格中调出每个脉冲i的检测边沿所对应的电位器电压V(i)；所述脉冲式旋转编码器的整刻度角度之外的细分角度所对应的电位器电压值通过所述第一差动电压放大电路和第二差动电压放大电路得到，所述第一差动电压放大电路包括第一运算放大器，所述第四电压跟随器的输出端通过R2连接第一运算放大器的同相端，第一运算放大器的同相端还通过R3接地，所述第二电压跟随器的输出端通过R2’连接第一运算放大器的反相端，此时使所述主检测电路的单片机输出的V(i)为已正转角度内与实际转角最邻近的整刻度角度对应的电位器电压V(i)，第一运算放大器的反相端和第一运算放大器的输出端之间连接R4，第一运算放大器的输出端通过R5连接所述单片机的第一A/D转换口，该第一差动电压放大电路的放大倍数为R4/R2’，所述第二差动电压放大电路包括第二运算本文档来自技高网...

【技术保护点】
基于闭环控制的机器人用精密液压驱动关节，包括闭环控制系统和用于机器人的转动关节，所述闭环控制系统包括单片机、电机驱动器、伺服电机、双向螺杆泵、摆动液压缸、以及检测摆动液压缸的输出轴的精确转动角度的电检测系统；所述单片机通过所述电机驱动器控制伺服电机转动，所述伺服电机驱动所述双向螺杆泵内的螺杆正向或反向旋转，所述双向螺杆泵具有位于一侧的第一输出端和位于另一侧的第二输出端，所述摆动液压缸的内腔由叶片分隔成第一液压腔和第二液压腔，所述双向螺杆泵的第一输出端通过第一管路和摆动液压缸的第一液压腔连通，所述双向螺杆泵的第二输出端通过第二管路和摆动液压缸的第二液压腔连通，当双向螺杆泵的螺杆正向旋转时，双向螺杆泵从其第一输出端出油，推动摆动液压缸的叶片正向转动后从第二输出端回油，当双向螺杆泵的螺杆反向旋转时，双向螺杆泵从其第二输出端出油，推动摆动液压缸的叶片反向转动后从第一输出端回油，所述双向螺杆泵、第一管路、第二管路、摆动液压缸构成闭式液压系统；所述摆动液压缸的输出轴连接机器人的一个转动关节，摆动液压缸的输出轴还通过传动比为1:1的钢带传动机构连接一检测轴，该钢带传动机构的传动带采用没有伸缩弹性的钢材质以保证瞬时传动比为1:1，从而保证摆动液压缸的输出轴和所述检测轴的转角的瞬间一致；所述电检测系统包括套装在所述检测轴上的脉冲式旋转编码器、转轴与脉冲式旋转编码器的动环通过弹性联轴器固接的旋转电位器、用于检测脉冲式旋转编码器的整刻度角度外的细分角度所对应电位器电压的细分角度电压检测电路，所述旋转电位器的电阻体两端连接标准电平，旋转电位器的滑动端由所述转轴带动在所述电阻体上转动滑行，旋转电位器的滑动端与电阻体的电压负极之间构成Vin，所述脉冲式旋转编码器可检测其分辨率内实际转角所对应的整刻度角度，整刻度角度外的细分角度由所述旋转电位器、细分角度电压检测电路、以及单片机获得，所述细分角度电压检测电路包括用于检测脉冲式旋转编码器的整刻度角度所对应的电位器电压V(i)以及所述检测轴的实际转角所对应的电位器电压Vin的主检测电路、螺杆正向旋转时用于放大Vin与V(i)之间差值的第一差动电压放大电路、螺杆反向旋转时用于放大V(i)与Vin之间差值的第二差动电压放大电路；所述主检测电路包括电压比较器、第一电压跟随器、第二电压跟随器、第三电压跟随器、第四电压跟随器、第五电压跟随器，所述电压比较器的同向端连接由所述单片机通过D/A转换模块或PWM产生模块产生的V(i)，所述电压比较器的反相端连接第一电压跟随器的输出端，当该电压比较器的同相端电压大于反向端电压时，电压比较器的输出端输出高电平，当该电压比较器的同相端电压小于反向端电压时，电压比较器的输出端输出低电平，所述第一电压跟随器的正输入端连接所述旋转电位器的滑动端的输出电压Vin，第一电压跟随器的负输入端直接连接其输出端，所述电压比较器的同相端还连接第二电压跟随器的正输入端，第二电压跟随器的负输入端直接连接其输出端，第二电压跟随器的输出端连接第三电压跟随器的正输入端，第三电压跟随器的负输入端直接连接其输出端，所述第一电压跟随器的输出端连接第四电压跟随器的正输入端，第四电压跟随器的负输入端直接连接其输出端，第四电压跟随器的输出端连接第五电压跟随器的正输入端，第五电压跟随器的负输入端直接连接其输出端；所述脉冲式旋转编码器的每个整刻度角度对应的旋转电位器的电压值可以预先得到，并存储到所述单片机的RAM内的表格里面，具体做法是，使伺服电机驱动双向螺杆泵的螺杆转动，使摆动液压缸的输出轴转动到脉冲式旋转编码器的整刻度角度i时，使摆动液压缸停止转动，此时该整刻度角度对应的电位器电压值为Vin，然后通过单片机调节所述D/A转换模块的输入数字量或者所述PWM产生模块的占空比，产生逐渐增大的电压V(i)，所述电压比较器的输出端通过限流电阻R1连接所述单片机的普通I/O口，当单片机检测到该普通I/O口的输入端TEST从低电平0突变为高电平1时，单片机停止调节V(i)，该突变时刻的V(i)即为该整刻度角度所对应的电位器电压值，然后再将对应此整刻度角度的V(i)和对应的脉冲数i保存到单片机的RAM内的表格里，依此做法检测脉冲式旋转编码器的下一整刻度角度对应的电压V(i+1)，直到检测完脉冲式旋转编码器所有的整刻度角度对应的电压值，这样就在单片机的RAM内预先建立了脉冲式旋转编码器的所有整刻度角度对应的电压值和相应脉冲数i的表格；所述脉冲式旋转编码器的输出连接至单片机的计数器的外部输入端口，计数器采用边沿中断触发工作方式，可以捕捉正反转情况下脉冲式旋转编码器待检测相的脉冲个数，当计数器检测到第i个脉冲时，单片机从RAM内预存的表格中调出第i个脉冲对应的电位器电压V(i)，因此在计数器对脉冲的检测作用下，每当所述检测轴转到脉冲式旋转编码器...

【技术特征摘要】
1.基于闭环控制的机器人用精密液压驱动关节，包括闭环控制系统和用于机器人的转动关节，所述闭环控制系统包括单片机、电机驱动器、伺服电机、双向螺杆泵、摆动液压缸、以及检测摆动液压缸的输出轴的精确转动角度的电检测系统；所述单片机通过所述电机驱动器控制伺服电机转动，所述伺服电机驱动所述双向螺杆泵内的螺杆正向或反向旋转，所述双向螺杆泵具有位于一侧的第一输出端和位于另一侧的第二输出端，所述摆动液压缸的内腔由叶片分隔成第一液压腔和第二液压腔，所述双向螺杆泵的第一输出端通过第一管路和摆动液压缸的第一液压腔连通，所述双向螺杆泵的第二输出端通过第二管路和摆动液压缸的第二液压腔连通，当双向螺杆泵的螺杆正向旋转时，双向螺杆泵从其第一输出端出油，推动摆动液压缸的叶片正向转动后从第二输出端回油，当双向螺杆泵的螺杆反向旋转时，双向螺杆泵从其第二输出端出油，推动摆动液压缸的叶片反向转动后从第一输出端回油，所述双向螺杆泵、第一管路、第二管路、摆动液压缸构成闭式液压系统；所述摆动液压缸的输出轴连接机器人的一个转动关节，摆动液压缸的输出轴还通过传动比为1:1的钢带传动机构连接一检测轴，该钢带传动机构的传动带采用没有伸缩弹性的钢材质以保证瞬时传动比为1:1，从而保证摆动液压缸的输出轴和所述检测轴的转角的瞬间一致；所述电检测系统包括套装在所述检测轴上的脉冲式旋转编码器、转轴与脉冲式旋转编码器的动环通过弹性联轴器固接的旋转电位器、用于检测脉冲式旋转编码器的整刻度角度外的细分角度所对应电位器电压的细分角度电压检测电路，所述旋转电位器的电阻体两端连接标准电平，旋转电位器的滑动端由所述转轴带动在所述电阻体上转动滑行，旋转电位器的滑动端与电阻体的电压负极之间构成Vin，所述脉冲式旋转编码器可检测其分辨率内实际转角所对应的整刻度角度，整刻度角度外的细分角度由所述旋转电位器、细分角度电压检测电路、以及单片机获得，所述细分角度电压检测电路包括用于检测脉冲式旋转编码器的整刻度角度所对应的电位器电压V(i)以及所述检测轴的实际转角所对应的电位器电压Vin的主检测电路、螺杆正向旋转时用于放大Vin与V(i)之间差值的第一差动电压放大电路、螺杆反向旋转时用于放大V(i)与Vin之间差值的第二差动电压放大电路；所述主检测电路包括电压比较器、第一电压跟随器、第二电压跟随器、第三电压跟随器、第四电压跟随器、第五电压跟随器，所述电压比较器的同向端连接由所述单片机通过D/A转换模块或PWM产生模块产生的V(i)，所述电压比较器的反相端连接第一电压跟随器的输出端，当该电压比较器的同相端电压大于反向端电压时，电压比较器的输出端输出高电平，当该电压比较器的同相端电压小于反向端电压时，电压比较器的输出端输出低电平，所述第一电压跟随器的正输入端连接所述旋转电位器的滑动端的输出电压Vin，第一电压跟随器的负输入端直接连接其输出端，所述电压比较器的同相端还连接第二电压跟随器的正输入端，第二电压跟随器的负输入端直接连接其输出端，第二电压跟随器的输出端连接第三电压跟随器的正输入端，第三电压跟随器的负输入端直接连接其输出端，所述第一电压跟随器的输出端连接第四电压跟随器的正输入端，第四电压跟随器的负输入端直接连接其输出端，第四电压跟随器的输出端连接第五电压跟随器的正输入端，第五电压跟随器的负输入端直接连接其输出端；所述脉冲式旋转编码器的每个整刻度角度对应的旋转电位器的电压值可以预先得到，并存储到所述单片机的RAM内的表格里面，具体做法是，使伺服电机驱动双向螺杆泵的螺杆转动，使摆动液压缸的输出轴转动到脉冲式旋转编码器的整刻度角度i时，使摆动液压缸停止转动，此时该整刻度角度对应的电位器电压值为Vin，然后通过单片机调节所述D/A转换模块的输入数字量或者所述PWM产生模块的占空比，产生逐渐增大的电压V(i)，所述电压比较器的输出端通过限流电阻R1连接所述单片机的普通I/O口，当单片机检测到该普通I/O口的输入端TEST从低电平0突变为高电平1时，单片机停止调节V(i)，该突变时刻的V(i)即为该整刻度角度所对应的电位器电压值，然后再将对应此整刻度角度的V(i)和对应的脉冲数i保存到单片机的RAM内的表格里，依此做法检测脉冲式旋转编码器的下一整刻度角度对应的电压V(i+1)，直到检测完脉冲式旋转编码器所有的整刻度角度对应的电压值，这样就在单片机的RAM内预先建立了脉冲式旋转编码器的所有整刻度角度对应的电压值和相应脉冲数i的表格；所述脉冲式旋转编码器的输出连接至单片机的计数器的外部输入端口，计数器采用边沿中断触发工作方式，可以捕捉正反转情况下脉冲式旋转编码器待检测相的脉冲个数，当计数器检测到第i个脉冲时，单片机从RAM内预存的表格中调出第i个脉冲对应的电位器电压V(i)，因此在计数器对脉冲的检测作用下，每当所述检测轴转到脉冲式旋转编码器的每个脉冲i的检测边沿，单片机都可以从RAM内预存的表格中调出每个脉冲i的检测边沿所对应的电位器电压V(i)；所述脉冲式旋转编码器的整刻度角度之外的细分角度所对应的电位器电压值通过所述第一差动电压放大电路和第二差动电压放大电路得到，所述第一差动电压放大电路包括第一运算放大器，所述第四电压跟随器的输出端通过R2连接第一运算放大器的同相端，第一运算放大器的同相端还通过R3接地，所述第二电压跟随器的输出端通过R2’连接第一运算放大器的反相端，此时使所述主检测电路的单片机输出的V(i)为已正转角度内与实际转角最邻近的整刻度角度对应的电位器电压V(i)，第一运算放大器的反相端和第一运算放大器的输出端之间连接R4，第一运算放大器的输出端通过R5连接所述单片机的第一A/...

【专利技术属性】
技术研发人员：李绣峰，王正初，
申请(专利权)人：台州学院，李绣峰，
类型：发明
国别省市：浙江;33