CN103197578A - 机器人电量监控*** - Google Patents
机器人电量监控*** Download PDFInfo
- Publication number
- CN103197578A CN103197578A CN2012100037327A CN201210003732A CN103197578A CN 103197578 A CN103197578 A CN 103197578A CN 2012100037327 A CN2012100037327 A CN 2012100037327A CN 201210003732 A CN201210003732 A CN 201210003732A CN 103197578 A CN103197578 A CN 103197578A
- Authority
- CN
- China
- Prior art keywords
- circuit
- power supply
- robot
- main control
- divider resistance
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Landscapes
- Manipulator (AREA)
Abstract
本发明公开了一种机器人电量监控***,包括电流采样电路、电压采样电路、电源控制电路、主控单片机和通讯电路;电流采样电路和电压采样电路设于机器人电源接入端,分别用于对电源的电流和电压进行采样并将采样结果传送给主控单片机;主控单片机用于根据电流采样结果和电压采样结果计算电源剩余电量值,在电量低于设定值通过通讯电路向机器人的主控制板发出报警提示并在必要时通过电源控制电路切断各电气模块的电源;电源控制电路用于给各电气模块供电或断电;电流采样电路、电压采样电路、电源控制电路和通讯电路均与所述主控单片机连接。本发明可对机器人的电量进行实时监控,在供电不正常时报警提示,提高机器人***的稳定性和安全性。
Description
技术领域
本发明涉及机器人控制领域,尤其涉及一种机器人电量监控***。
背景技术
现有的机器人***需要配有专用的UPS***或需要配备电池以备当突然掉电或电源性能不好时,不至于对整个机器人***的主控计算机造成损坏,如果不足,需要关闭操作***并提示用户充电。另外,机器人控制***为Windows,即使电量充足在关机时也要先关闭***再切断电源,否则会对磁盘造成损坏。
发明内容
本发明主要是在现有的机器人***中对整个机器人***的电量进行实时监控,当电源工作不正常时可以发出报警,并经过一段延时关闭机器人***,增加了机器人***的稳定性和安全性。
为解决上述技术问题,本发明采用的一个技术方案是:提供一种机器人电量监控***,包括电流采样电路、电压采样电路、电源控制电路、主控单片机和通讯电路;所述电流采样电路和电压采样电路设于机器人电源接入端,分别用于对电源的电流和电压进行采样并将采样结果传送给所述主控单片机;所述主控单片机用于根据电流采样结果和电压采样结果计算电源剩余电量值,在电量低于设定值通过通讯电路向机器人的主控制板发出报警提示并在必要时通过电源控制电路切断各电气模块的电源;所述电源控制电路用于根据人工控制或主控单片机的控制信号导通或切断电源以给各电气模块供电或断电;所述电流采样电路、电压采样电路、电源控制电路和通讯电路均与所述主控单片机连接。
其中,所述机器人电量监控***还包括用于采集机器人温度的温度传感器,所述温度传感器连接所述主控单片机。
其中,所述主控单片机还用于在电流超过预设值时控制电源控制电路切断各电气模块的电源。
其中,所述机器人电量监控***还包括锁存器,所述锁存器用于对上电自锁信号进行锁存,所述锁存器输入端连接所述主控单片机,锁存器输出端连接所述电源控制电路。
其中,所述电源控制电路包括PMOS管、三极管、第一分压电阻、第二分压电阻、第二二极管、第三二极管和按键;第一分压电阻的一端连接至电源,第一分压电阻另一端连接第二分压电阻的一端,第二分压电阻的另一端通过第二二极管和按键接地,且第二分压电阻的该端还连接三极管的集电极,三极管的发射极接地,三极管的基极连接至锁存器的输出端;按键与第二二极管连接的公共接点还连接第三二极管的负极,第三二极管的正极连接至所述主控单片机;第一分压电阻与第二分压电阻的公共接点连接所述PMOS管的栅极,所述PMOS管的漏极连接至电源,源极连接所述主控单片机为主控单片机供电。
其中,所述锁存器主要由D触发器构成。
其中,所述通讯电路中设置有串行总线接口,所述串行总线接口用于与机器人主控制板连接通讯。
本发明的有益效果是:本发明在机器人***中对机器人***的电量进行实时监控,通过对电源电流和电压的采集,计算出电源剩余电量,当发生电量不足等供电电源异常时可以发出报警并通知上位机关闭***,防止由于机器人***突然失电对电气设备造成损坏,提高机器人***运行的稳定性和安全性。
附图说明
图1是本发明的机器人电量监控***的***框图。
图2是本发明的机器人电量监控***的电路结构示意图。
图3是本发明的机器人电量监控***中电源控制电路的结构示意图。
图4是本发明的机器人电量监控***中锁存器的结构示意图。
图中:
1、电池,2、电流采样电路,3、电压采样电路,4、上电电路,5、直流/直流电源,6、主控单片机,7、驱动电路,8、开关管,9、通讯电路,10、主控制板,11、温度传感器,12、电机控制器。
具体实施方式
为详细说明本发明的技术内容、构造特征、所实现目的及效果,以下结合实施方式并配合附图详予说明。
本发明主要是为了提供一种机器人电量监控***,用于对机器人***中的UPS***或备用电池等备用电源的电量进行监控,以防止电量不足对机器人***的主控计算机造成损坏。参阅图1和图2,在本发明电量监控***的一实施例中,电量监控***包括电流采样电路2、电压采样电路3、上电电路4、驱动电路7、开关管8、主控单片机6和通讯电路9;其中上电电路4、驱动电路7和开关管8共同构成电源控制电路。
电流采样电路2和电压采样电路3设于机器人电源接入端与电池1连接分别用于对电池1的电流和电压进行采样并将采样结果传送给所述主控单片机6的AD端口(AD0、AD1、AD5、AD6);主控单片机6可根据电流采样结果和电压采样结果计算电源剩余电量值并产生相应的控制信号,主控单片机6的UART端口连接有用于与主控制板10连接通讯的通讯电路9,该通讯电路9可采用多种方式与主控制板10连接,在本例中,通讯电路9与主控制板10采用RS232串行总线进行数据通讯,主控单片机6在电量低于设定值可通过通讯电路9向机器人的主控制板10发出报警提示,当电量无法续航时,通过驱动电路7来控制开关管8切断各电气模块如图中所示的直流/直流电源5、主控制板10以及电机控制器12的电源。
上电电路4的输入端通过电流采样电路2接电池,输出端通过直流/直流电源5连接主控单片机6的电源端POWER,该上电电路4可根据人工控制或主控单片机6的控制信号导通或切断与电池1的连接以给主控单片机6供电或断电,直流/直流电源5对上电电路4的输出电压进行电源转换以获得符合主控单片机6工作要求的电压。驱动电路7的输入端连接主控单片机6的I/O端口,输出端接开关管8的控制端,开关管8的输入端通过电流采样电路2连接至电池1,开关管8输出端连接其他外设如主控制板10和电机控制器12等,主控单片机6通过I/O端口向驱动电路7发出控制信号然后该控制信号被用于对开关管8的状态进行控制,从而达到导通或截止外设电源的效果。
在一具体实施例中,本发明的电量监控***在机器人上电后即开始工作,可以按需设置电量检测的周期,例如设置为每2分钟检测一次时,电流采样电路2和电压采样电路3每2分钟对电池1的电流和电压进行一次采样,主控单片机6接收电流采样电路2和电压采样电路3的采样结果,计算出电池剩余电量,然后通过通讯电路9向主控制板10发送剩余电量值。当电量低于15%(该数值可以根据需要另行设置)时,通过通讯电路9向主控制板10发送电量低警告,建议充电;当电量低于5%(同样,该数值也可以根据需要设置)时,通过通讯电路9向主控制板10发送电量即将用完警告以及关闭操作***的命令,通过驱动电路7控制开关管8延时10s,切断所有电气设备电源。当电流超过预设值一段时间(比如5ms)时,主控单片机6控制电源控制电路切断所有电气设备电源以避免过流损坏设备。
除了对电源的电流和电压进行采样得到电量数据外,主控单片机6还可以扩展连接温度传感器11,温度传感器11对机器人***的温度进行实时监控,主控单片机6在温度异常时相应地传送相关信号通知主控制板10作出关闭***等消除危险的动作。
为了防止当CPU工作不正常时,I/O的状态突然改变导致不安全关机,可以采用芯片电源处加大容量电容的方案,这样可以使当CPU重启动时,保证自锁的信号可以输出短时间的高电平信号,但由于采用电容的方案时只能保持很短的时间,因此,在一实施例中,电量监控***中还包括一锁存器,用于对上电自锁信号进行锁存,锁存器输入端连接主控单片机,锁存器输出端连接上电电路。参阅图4,在一具体的锁存信号设计中,采用D触发器对上电自锁信号进行锁存,锁存器U3由主控单片机6向其电源端VCC提供3.3V电压对其供电,输入锁存器U3的输入端D1的信号P12即为主控单片机6由I/O端口输出的自锁信号,锁存器U3的输出端Q1输出信号O12连接至上电电路,对上电电路的上电进行控制。
图3给出了机器人电量监控***中电源控制电路的一具体电路结构,电源控制电路包括PMOS管Q1、三极管Q2、第一分压电阻R6、第二分压电阻R9、第二二极管D2、第三二极管D3和按键SW2;第一分压电阻R6的一端连接至电源,第一分压电阻R6另一端连接第二分压电阻R9的一端,第二分压电阻R9的另一端通过第二二极管D2和按键SW2接地,且第二分压电阻R9的该端还连接三极管Q2的集电极,三极管Q2的发射极接地,三极管Q2的基极经电阻R8、R7接地,电阻R8与电阻R7连接的公共接点连接至锁存器的输出端;按键SW2与第二二极管D2连接的公共接点还连接第三二极管D3的负极,第三二极管D3的正极连接至所述主控单片机;第一分压电阻R6与第二分压电阻R9的公共接点连接所述PMOS管Q1的栅极,所述PMOS管Q1的漏极连接至电源,源极连接所述主控单片机为主控单片机供电。
机器人使用电池或外接电源供电,有一总开关控制总电源通断。总开关一般处于常开状态,电流经过总开关到达电源控制模块。电源控制模块由安装在机器人外罩明显处的按钮控制。当机器人未上电时,用户按一下按键SW2,24V(D24)经过电阻R6、R9、二极管D2和按键SW2到GND,此时电阻R6两端的电压压降使PMOS管Q1的漏极和源极开通,24V输入电压(D24)经PMOS管Q1的源极输出(E24),主控单片机6上电,主控单片机6上电后使P12口输出高电平,该信号P12输入至锁存器U3的输入端,锁存器输出信号O12使三极管Q2集电极和发射极导通,此时24V(D24)通过电阻R6、R9、三极管Q2到GND,此时仍可以保证电阻R6两端的电压差,使PMOS管Q1持续开通,上电成功。
开机后,主控单片机6设置P19为高电平,当按下按键SW2时P19为低电平,当长按按键4秒,P19接受到超过4秒的低电平时,主控单片机6产生关机信号,通知外设关闭,当所有外设关闭后,单片机使P12输出为低电平,将自己关闭。
本发明在机器人***中对机器人***的电量进行实时监控,通过对电源电流和电压的采集,计算出电源剩余电量,当发生电量不足等供电电源异常时可以发出报警并通知上位机关闭***,防止由于机器人***突然失电对电气设备造成损坏,提高机器人***运行的稳定性和安全性。
另外也可以在电流过大时关闭机器人***提供过流保护;此外还能提供温度参数的采集防止机器人过热。进一步提高机器人***的安全性。
以上所述仅为本发明的实施例,并非因此限制本发明的专利范围,凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其他相关的技术领域,均同理包括在本发明的专利保护范围内。
Claims (7)
1.一种机器人电量监控***,其特征在于,包括电流采样电路、电压采样电路、电源控制电路、主控单片机和通讯电路;
所述电流采样电路和电压采样电路设于机器人电源接入端,分别用于对电源的电流和电压进行采样并将采样结果传送给所述主控单片机;
所述主控单片机用于根据电流采样结果和电压采样结果计算电源剩余电量值,在电量低于设定值通过通讯电路向机器人的主控制板发出报警提示并在必要时通过电源控制电路切断各电气模块的电源;
所述电源控制电路用于根据人工控制或主控单片机的控制信号导通或切断电源以给各电气模块供电或断电;
所述电流采样电路、电压采样电路、电源控制电路和通讯电路均与所述主控单片机连接。
2.根据权利要求1所述的机器人电量监控***,其特征在于:还包括用于采集机器人温度的温度传感器,所述温度传感器连接所述主控单片机。
3.根据权利要求1所述的机器人电量监控***,其特征在于:所述主控单片机还用于在电流超过预设值时控制电源控制电路切断各电气模块的电源。
4.根据权利要求1所述的机器人电量监控***,其特征在于,还包括锁存器,所述锁存器用于对上电自锁信号进行锁存,所述锁存器输入端连接所述主控单片机,锁存器输出端连接所述电源控制电路。
5.根据权利要求4所述的机器人电量监控***,其特征在于:所述电源控制电路包括PMOS管、三极管、第一分压电阻、第二分压电阻、第二二极管、第三二极管和按键;
第一分压电阻的一端连接至电源,第一分压电阻另一端连接第二分压电阻的一端,第二分压电阻的另一端通过第二二极管和按键接地,且第二分压电阻的该端还连接三极管的集电极,三极管的发射极接地,三极管的基极连接至锁存器的输出端;按键与第二二极管连接的公共接点还连接第三二极管的负极,第三二极管的正极连接至所述主控单片机;
第一分压电阻与第二分压电阻的公共接点连接所述PMOS管的栅极,所述PMOS管的漏极连接至电源,源极连接所述主控单片机为主控单片机供电。
6.根据权利要求4所述的机器人电量监控***,其特征在于:所述锁存器主要由D触发器构成。
7.根据权利要求1-6任一项所述的机器人电量监控***,其特征在于:所述通讯电路中设置有串行总线接口,所述串行总线接口用于与机器人主控制板连接通讯。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2012100037327A CN103197578A (zh) | 2012-01-06 | 2012-01-06 | 机器人电量监控*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2012100037327A CN103197578A (zh) | 2012-01-06 | 2012-01-06 | 机器人电量监控*** |
Publications (1)
Publication Number | Publication Date |
---|---|
CN103197578A true CN103197578A (zh) | 2013-07-10 |
Family
ID=48720243
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2012100037327A Pending CN103197578A (zh) | 2012-01-06 | 2012-01-06 | 机器人电量监控*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103197578A (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104345354A (zh) * | 2014-10-28 | 2015-02-11 | 陕西千山航空电子有限责任公司 | 一种恶劣环境中的智能低功耗航空气象观测*** |
CN104635821A (zh) * | 2013-11-14 | 2015-05-20 | 沈阳新松机器人自动化股份有限公司 | 面向服务机器人的电量监控装置 |
CN104771914A (zh) * | 2015-04-17 | 2015-07-15 | 永州市行速电子科技有限公司 | 摇柄按键式无线摇控装置及由该装置遥控的拳击机器人玩具 |
CN106625728A (zh) * | 2016-11-17 | 2017-05-10 | 马艳敏 | 一种家用辅助切断电源的装置 |
CN107942804A (zh) * | 2017-12-04 | 2018-04-20 | 山东超越数控电子股份有限公司 | 一种基于单片机的服务器电源智能管理*** |
CN108406799A (zh) * | 2018-03-18 | 2018-08-17 | 张杭湖 | 一种仿生六足机器人 |
CN109782647A (zh) * | 2017-11-10 | 2019-05-21 | 威刚科技股份有限公司 | 应用于智能机器人的省电***及其省电方法 |
CN110429560A (zh) * | 2019-07-26 | 2019-11-08 | 上海快仓智能科技有限公司 | 移动机器人的电源管理***、电源管理方法和移动机器人 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006351418A (ja) * | 2005-06-17 | 2006-12-28 | Matsushita Electric Ind Co Ltd | 電力管理システムおよびその管理方法 |
CN101833068A (zh) * | 2009-06-04 | 2010-09-15 | 深圳市朗科科技股份有限公司 | 手机电池剩余电量的检测装置及方法 |
CN102005796A (zh) * | 2010-12-07 | 2011-04-06 | 深圳市思倍生电子科技有限公司 | 移动电源及其控制方法 |
CN201926746U (zh) * | 2011-01-12 | 2011-08-10 | 启明信息技术股份有限公司 | 电动汽车用电池管理***电池荷电状态校准器 |
-
2012
- 2012-01-06 CN CN2012100037327A patent/CN103197578A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006351418A (ja) * | 2005-06-17 | 2006-12-28 | Matsushita Electric Ind Co Ltd | 電力管理システムおよびその管理方法 |
CN101833068A (zh) * | 2009-06-04 | 2010-09-15 | 深圳市朗科科技股份有限公司 | 手机电池剩余电量的检测装置及方法 |
CN102005796A (zh) * | 2010-12-07 | 2011-04-06 | 深圳市思倍生电子科技有限公司 | 移动电源及其控制方法 |
CN201926746U (zh) * | 2011-01-12 | 2011-08-10 | 启明信息技术股份有限公司 | 电动汽车用电池管理***电池荷电状态校准器 |
Non-Patent Citations (1)
Title |
---|
滕学志: "自主水下机器人能源与动力***设计", 《中国硕士论文数据库》 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104635821A (zh) * | 2013-11-14 | 2015-05-20 | 沈阳新松机器人自动化股份有限公司 | 面向服务机器人的电量监控装置 |
CN104345354A (zh) * | 2014-10-28 | 2015-02-11 | 陕西千山航空电子有限责任公司 | 一种恶劣环境中的智能低功耗航空气象观测*** |
CN104771914A (zh) * | 2015-04-17 | 2015-07-15 | 永州市行速电子科技有限公司 | 摇柄按键式无线摇控装置及由该装置遥控的拳击机器人玩具 |
CN106625728A (zh) * | 2016-11-17 | 2017-05-10 | 马艳敏 | 一种家用辅助切断电源的装置 |
CN109782647A (zh) * | 2017-11-10 | 2019-05-21 | 威刚科技股份有限公司 | 应用于智能机器人的省电***及其省电方法 |
CN107942804A (zh) * | 2017-12-04 | 2018-04-20 | 山东超越数控电子股份有限公司 | 一种基于单片机的服务器电源智能管理*** |
CN108406799A (zh) * | 2018-03-18 | 2018-08-17 | 张杭湖 | 一种仿生六足机器人 |
CN110429560A (zh) * | 2019-07-26 | 2019-11-08 | 上海快仓智能科技有限公司 | 移动机器人的电源管理***、电源管理方法和移动机器人 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103197578A (zh) | 机器人电量监控*** | |
CN201985627U (zh) | 一种配电终端以及使用该配电终端的智能电网*** | |
CN203434637U (zh) | 蓄能*** | |
CN202721445U (zh) | 智能型无功补偿集成模块 | |
CN204425271U (zh) | 具有电弧检测功能的光伏监控装置 | |
CN106787148B (zh) | 一种光伏储能逆变器辅助开关电源*** | |
CN201359640Y (zh) | 智能供电地面测报机 | |
TWI628890B (zh) | Synchronous control system architecture to improve energy efficiency | |
CN102684294B (zh) | 嵌入式设备主备用电源控制装置 | |
CN204129114U (zh) | 变压器电能表 | |
CN208461470U (zh) | 一种变频器防低电压穿越装置 | |
CN205039618U (zh) | 一种配变监测终端 | |
CN201270385Y (zh) | 智能综合配电箱 | |
CN111124029B (zh) | 一种外置开关通断电控制电路及其方法 | |
CN209913577U (zh) | 物联网低压台区配变智能断路器控制器 | |
CN203466592U (zh) | 一种离网型光伏储能***的启动电路 | |
CN207504636U (zh) | 一种具有断电保护功能的投影仪 | |
CN202494721U (zh) | 远程多相费控电能表 | |
CN206442173U (zh) | 太阳能路灯的充放电控制设备 | |
CN201742135U (zh) | 电源智能管理装置 | |
CN213521387U (zh) | 一种电源智能控制器 | |
CN206251117U (zh) | 一种失电状态下持续运行的物联网网关 | |
CN102882266A (zh) | 具有监测功能的发电机组控制*** | |
CN104158246A (zh) | 一种风电储能运行控制方法 | |
CN203933140U (zh) | 一种电缆负荷电流ct取电智能电源装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C02 | Deemed withdrawal of patent application after publication (patent law 2001) | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20130710 |