一种防止机器人过度转动控制系统技术方案

本实用新型专利技术公开一种防止机器人过度转动控制系统，该控制系统包括系统主CPU、两个或四个终点开关、与每个终点开关对应的终点检测控制电路、马达驱动；当机器人转动到某一方位的终点时，所述终点开关触发终点检测控制电路切断马达驱动，并通知系统主CPU，系统主CPU随之控制马达驱动进入释放状态。本实用新型专利技术提供的防止机器人过度转动控制系统，可以在头部运动到终点的时候立即切断马达，并通知CPU，CPU能随后控制马达进入释放状态，不会对机械结构造成过冲现象，由于该电路是先主动切断马达再通知CPU进行处理，而传统的办法是先通知CPU，再由CPU来控制驱动芯片进入停止模式，即使CPU死机也能起到保护机械结构的作用。

【技术实现步骤摘要】

本技术涉及机器人控制系统，尤其涉及一种防止机器人过度转动控制系统。
技术介绍
对于机器人头部转动或点头的控制，目前的技术是在头部转动到终点的时候触发一个机械开关，开关的电平变化传输到CPU，CPU立即控制马达驱动芯片停止驱动，达到停止转动的目的。目前的技术由于存在CPU检测转动终点的信号，再由CPU进行控制，此过程需要时间，这个时间可能导致机械结构过冲；另外如果CPU死机，也可能导致CPU无法控制，机械结构一直处于过冲状态；这两种情况都可能损坏机械结构、齿轮箱、马达等元器件。
技术实现思路
本技术的目的是克服现有技术的不足，提供一种防止机器人过度转动控制系统。本技术的技术方案如下：一种防止机器人过度转动控制系统，该控制系统包括系统主CPU、两个或四个终点开关、与每个终点开关对应的终点检测控制电路、马达驱动；所述系统主CPU与马达驱动电性连接；所述终点检测控制电路分别与系统主CPU、马达驱动电性连接；所述终点开关与对应的终点检测控制电路电性连接；当机器人转动到某一方位的终点时，所述终点开关触发终点检测控制电路切断马达驱动，并通知系统主CPU，系统主CPU随之控制马达驱动进入释放状态。较佳地，该控制系统包含两个终点开关，为左边终点开关、右边终点开关。较佳地，该控制系统包含两个终点开关，为上边终点开关、下边终点开关。较佳地，该控制系统包含四个终点开关，为左边终点开关、右边终点开关、上边终点开关、下边终点开关。采用上述方案，本技术提供的防止机器人过度转动控制系统，可以在头部运动到终点的时候立即切断马达，并通知CPU，CPU能随后控制马达进入释放状态，效果非常明显，不会对机械结构造成过冲现象，由于该电路是先主动切断马达再通知CPU进行处理，而传统的办法是先通知CPU，再由CPU来控制驱动芯片进入停止模式，实际证明，即使CPU死机也能起到保护机械结构的作用。附图说明图1为本技术实施例为四个终点开关的控制原理图；图2为本技术实施例为两个终点开关的电路原理图。具体实施方式以下结合附图和具体实施例，对本技术进行详细说明。参见图1与图2，本技术提供一种防止机器人过度转动控制系统，该控制系统包括系统主CPU101、两个或四个终点开关102、与每个终点开关102对应的终点检测控制电路103、马达驱动104；所述系统主CPU101与马达驱动104电性连接；所述终点检测控制电路103分别与系统主CPU101、马达驱动104电性连接；所述终点开关102与对应的终点检测控制电路103电性连接；当机器人转动到某一方位的终点时，所述终点开关102触发终点检测控制电路103切断马达驱动104，并通知系统主CPU101，系统主CPU101随之控制马达驱动104进入释放状态。所述控制系统包含四个终点开关102，为左边终点开关102a、右边终点开关102b、上边终点开关102c、下边终点开关102d。本技术的工作原理如下：参照图1与图2，以转头为例进行阐述（点头原理相同）。U24为马达驱动芯片，J36为头部转动到最左边的左边终点开关102a，J37为头部转动到最右边的右边终点开关102b。当头部转动到最左边的时候，J36的1脚和3脚接通，Q117和Q118导通，Q4和Q5不导通，U24的第2、3两脚为高电平，U24进入刹车模式。马达立即刹车，不会对机械结构过冲。同时FB-RL-L网络为高电平，系统主CPU101检测到FB-RL-L的高电平，即判断转动到最左边，于是系统主CPU101控制网络MTR-RL-L和网络MTR-RL-R为高电平，并将FB-RL-L输出低电平，此时马达处于释放状态。当头部转动到最右边的时候，J37的1脚和3脚接通，Q119和Q120导通，Q4和Q5不导通，U24的第2、3两脚为高电平，U24进入刹车模式。马达立即刹车，不会对机械结构过冲。同时FB-RL-R网络为高电平，系统主CPU101检测到FB-RL-R的高电平，即判断转动到最左边，于是系统主CPU101控制网络MTR-RL-L和网络MTR-RL-R为高电平，并将FB-RL-R输出低电平，此时马达处于释放状态。以上仅为本技术的较佳实施例而已，并不用于限制本技术，凡在本技术的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本技术的保护范围之内。本文档来自技高网...

【技术保护点】
一种防止机器人过度转动控制系统，其特征在于，该控制系统包括系统主CPU、两个或四个终点开关、与每个终点开关对应的终点检测控制电路、马达驱动；所述系统主CPU与马达驱动电性连接；所述终点检测控制电路分别与系统主CPU、马达驱动电性连接；所述终点开关与对应的终点检测控制电路电性连接；当机器人转动到某一方位的终点时，所述终点开关触发终点检测控制电路切断马达驱动，并通知系统主CPU，系统主CPU随之控制马达驱动进入释放状态。

【技术特征摘要】
1.一种防止机器人过度转动控制系统，其特征在于，该控制系统包括系统主CPU、两个或四个终点开关、与每个终点开关对应的终点检测控制电路、马达驱动；所述系统主CPU与马达驱动电性连接；所述终点检测控制电路分别与系统主CPU、马达驱动电性连接；所述终点开关与对应的终点检测控制电路电性连接；当机器人转动到某一方位的终点时，所述终点开关触发终点检测控制电路切断马达驱动，并通知系统主CPU，系统主CPU随之控制...

【专利技术属性】
技术研发人员：谢德福，王建平，赵其纯，
申请(专利权)人：深圳市海纳天亨科技有限公司，
类型：新型
国别省市：广东;44