CN100398271C - 一种机器人智能控制装置 - Google Patents

一种机器人智能控制装置 Download PDF

Info

Publication number
CN100398271C
CN100398271C CNB2006100521729A CN200610052172A CN100398271C CN 100398271 C CN100398271 C CN 100398271C CN B2006100521729 A CNB2006100521729 A CN B2006100521729A CN 200610052172 A CN200610052172 A CN 200610052172A CN 100398271 C CN100398271 C CN 100398271C
Authority
CN
China
Prior art keywords
pin
circuit
signal
microprocessor
output signal
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.)
Expired - Fee Related
Application number
CNB2006100521729A
Other languages
English (en)
Other versions
CN1895857A (zh
Inventor
陈纯
应放天
潘云鹤
卜佳俊
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hangzhou Yinao Intelligence Technology Co Ltd
Original Assignee
Zhejiang University ZJU
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Zhejiang University ZJU filed Critical Zhejiang University ZJU
Priority to CNB2006100521729A priority Critical patent/CN100398271C/zh
Publication of CN1895857A publication Critical patent/CN1895857A/zh
Application granted granted Critical
Publication of CN100398271C publication Critical patent/CN100398271C/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明涉及一种机器人智能控制装置。本发明所要解决的技术问题是提供一种用单片机和红外线收发技术实现自动导航、避障、检测和操作的机器人智能控制装置。解决该问题的技术方案是：一种机器人智能控制装置，其特征在于该控制装置包括单片机主控单元、A/D转换器、电压检测电路、气体检测电路、颗粒流量检测电路、防撞电路、对地红外防跌落电路、导航电路、驱动电路和电源电路。本发明可用于在家庭、公共服务空间等场所进行清洁等服务。

Description

一种机器人智能控制装置
技术领域
本发明涉及一种机器人智能控制装置。适用于在家庭、公共服务空间等场所进行清洁等服务。
背景技术
目前，机器人大都应用接触性传感器实现机器人自主导航，这类装置精度比较高，须利用超声数据，识别和跟踪道路边缘，将超声数据与图像数据结合，通过事先训练好的神经网络来预测障碍物可能位置，使机器人在动态非结构化环境中实现自主导航。家用服务型机器人由于制造成本和生产工艺的因素，以上技术在应用上则较为困难，另外，现有的机器人还存在着人为参与动作过多，功耗高，噪音大等问题。
发明内容
本发明要解决的技术问题是：提供一种用单片机和红外线收发技术实现自动导航、避障、检测和操作的机器人智能控制装置。
本发明所采用的技术方案是：一种机器人智能控制装置，其特征在于该控制装置包括单片机主控单元、A/D转换器、电压检测电路、气体检测电路、颗粒流量检测电路、防撞电路、对地红外防跌落电路、导航电路、驱动电路和电源电路，其中：
单片机主控单元由微处理器A和微处理器B组成，微处理器A、微处理器B和A/D转换器之间通过功能端脚互相连接，实现控制装置的数据交换与操作；
电压检测电路的输出信号送到处理器B的脚2，用于监控装置的电压；
气体检测电路的输出信号送到微处理器B的脚8，用于判断空气的综合质量；
颗粒流量检测电路由一对红外发射、接收管采集信号，输出的电信号发送至A/D转换器的脚19，转换成数字信号后进入微处理器A进行处理，输出信号用于控制驱动电路；
防撞电路由二对红外发射、接收管采集信号，输出的二路信号分别输至微处理器B的脚9和脚11，输出信号用于控制驱动电路；
对地红外防跌落电路由四对红外发射、接收管采集信号，其输出信号经放大后接入微处理器A的脚40、脚7、脚5、脚8，输出信号用于控制驱动电路；
导航电路由四对红外发射、接收管和二对霍尔传感器采集信号，输出信号经多路切换电路U4后输出到运算放大器U2进行信号处理，处理过的信号经运算放大器U2的脚7输出至A/D转换器的脚14进行A/D转换，转换后的数字信号进入微处理器A进行处理，输出信号用于控制驱动电路；
驱动电路接受微处理器A的控制，由第一四位数值比较器U9、第二四位数值比较器U10，电机驱动器U11和晶振电路U8组成，第一四位数值比较器U9、第二四位数值比较器U10取样电平由晶振电路U8的脚3、脚4、脚5、脚6在4M晶振分频后得到，电机驱动器U11的输出信号分别控制两个减速电机的方向和速度。
本发明的有益效果是：通过单片机控制和红外线收发技术，采用直接自适应器对机器人进行轨迹控制的方案；进行脉宽调制(PWM)分段，步进式输出1Hz～3kHz的PWM，它占用的CPU时间短。可实现服务型机器人的自动导航、避障、检测和操作，无须人为操作，此设计的结构简单、成本低、可靠性好、抗干扰能力强。
附图说明
图1是本发明的装置结构图。
图2-1是本发明的原理总图。
图2-2是本发明的另一原理总图。
图3是图2-2中电压检测电路的原理图。
图4是图2-2中气体检测电路的原理图。
图5是图2-1中颗粒流量检测电路的原理图。
图6是图2-2中防撞电路的原理图。
图7是图2-1中对地红外防跌落电路的原理图。
图8是图2-1中导航电路的原理图。
图9是图2-1中驱动电路的原理图。
图10是图2-1中电源电路的原理图。
图11是图2-1中电源开关电路的原理图。
图12是图2-1中风机及告警电路的原理图。
具体实施方式
如图1所示，本实施例由微处理器A1、微处理器B2、A/D转换器3、电压检测电路4、气体检测电路5、颗粒流量检测电路6、防撞电路7、对地红外防跌落电路8、导航电路9、驱动电路10和电源电路11组成。
如图2、图3所示，微处理器A(U12型号68HC705C9A，以下简称U12)1和微处理器B(U301型号AT89C2051，以下简称U301)2组成单片机主控单元，单片机主控单元和A/D转换器3(U3型号68HC68，以下简称U3)之间通过功能端脚互相连接，实现控制装置的数据交换与操作。
电压检测电路4由电阻R301、R302、R303、W1组成取样电路，取样电压经分压后输送到比较器U300A(型号LM393)，U300A的脚2大约有2.5V左右的电压，而U300A脚3的电压经分压后如果此电位高于脚2的电位，U300A的脚1输出高电平，反之输出低电平，输出信号送到U301的脚2，用于监控装置的电压并点亮LED。
气体检测电路5中的气体探头检测出空气质量污染严重时，由J303的脚3输出高电平信号，送到比较器U300B的脚6，与U300B的脚5做电位比较，由于脚6为反向输入端，此时U300B的脚7输出低电平，送到U301的脚8。如果空气质量良好，则U300B的脚7输出高电平。电阻R323、W2、C306组成一个基准电压电路。
颗粒流量检测电路6由JP7的脚4、5导通5V红外线发射管，该管与JP9的脚5的接收管形成对射，当固体颗粒扰动，使红外线接收量降低，形成低电平，直接发送信号到U3的脚19，转换成数字信号后进入微处理器U12进行处理，输出信号用于控制驱动电路10。
防撞电路7由二对红外发射、接收管IR5、IR6采集信号，从J302的脚1、脚4输出二路信号，分别经三极管Q302、Q303放大后输至微处理器U301的脚11和脚9，输出信号用于控制驱动电路10。
对地红外防跌落电路8由四对红外发射、接收管采集信号，红外接收管的输入信号分别输到JP9的脚7、JP7的脚1、JP5脚3、JP2的脚5，其输出信号分别通过JP9的脚7、JP7的脚1、JP5的脚3、JP2的脚5输送到三极管Q801、Q802、Q803、Q804的基极，信号经放大后接入微处理器U12的脚40、脚7、脚5、脚8，输出信号用于控制驱动电路10。
导航电路9由四对红外发射、接收管和二对霍尔传感器采集信号，红外接收管IR1、IR2、IR3、IR4的输入信号分别送到多路切换电路U4(型号MC14052B)的脚11、12、15、14，U4的输出信号通过脚13、3输出到U2(型号TLV2274M)的脚13、10进行信号处理，处理过的信号经U2的脚7输出至U3的脚14进行A/D转换，转换后的数字信号进入微处理器U12进行处理，输出信号用于控制驱动电路10。
霍尔传感器H1、H2的输出信号输送到U3的脚9和脚11，经过A/D转换后的时序脉冲进入微处理器U12的脚34、35，经CPU运算后控制驱动电路10中电机的转向。
驱动电路10接受微处理器U12的控制，由四位数值比较器U9(型号MC74HC85)和U10(型号MC74HC85)，电机驱动器U11(型号L6204)和晶振电路U8(型号SN74HC393)组成。控制信号由微处理器U12的脚13、14、15、16脚输出至四位数值比较器U9的脚10、12、13、15，微处理器U12的脚18、19、20、21输出至四位数值比较器U10的脚10、12、13、15，经判断后，其中一路U9的脚7和脚5输出到U11的脚9和脚12，再由U11的脚4和脚18输出，控制JP2的脚1、2的右减速电机的速度；另一路U10的脚7和脚5输出到U11的脚2和脚19，由U11的脚7和脚13输出，控制JP5的脚1、2左减速电机的速度。U9、U10的取样电平由U8的脚3、4、5、6在4M晶振分频后得到。
电源电路11，12V电池电压经三端稳压管U5(型号78L05)稳压后，输出5V电压，供给机器电源。其中U13为主5V，供给CPU及其外设，U5为从5V，供给探头及U2、U6(型号TLV2272M)。
电源开关电路，当按下电源“开”键时，Q5的基极处于高电平，Q5导通，继电器吸合，U12在通电后从脚12输出高电平锁住Q5的基极电位，让继电器一直处于吸合状态。当按下“关”键时，Q5的基极为低电平，三极管截止，继电器断开。
风机及告警电路，当要启动12V电机时，U12的脚10输出高电平，Q6导通，风机开始工作。R15为下拉电阻，R1为保护电阻。同理，当设备在需要告警时，U12的脚9输出高电平，Q3导通，蜂鸣器得电发出告警声音。

Claims (1)

1.一种机器人智能控制装置，其特征在于该控制装置包括单片机主控单元、A/D转换器(3)、电压检测电路(4)、气体检测电路(5)、颗粒流量检测电路(6)、防撞电路(7)、对地红外防跌落电路(8)、导航电路(9)、驱动电路(10)和电源电路(11)，其中：
单片机主控单元由微处理器A(1)和微处理器B(2)组成，微处理器A(1)、微处理器B(2)和A/D转换器(3)之间通过功能端脚互相连接，实现控制装置的数据交换与操作；
电压检测电路(4)的输出信号送到处理器B(2)的脚2，用于监控装置的电压；
气体检测电路(5)的输出信号送到微处理器B(2)的脚8，用于判断空气的综合质量；
颗粒流量检测电路(6)由一对红外发射、接收管采集信号，输出的电信号发送至A/D转换器(3)的脚19，转换成数字信号后进入微处理器A(1)进行处理，输出信号用于控制驱动电路(10)；
防撞电路(7)由二对红外发射、接收管采集信号，输出的二路信号分别输至微处理器B(2)的脚9和脚11，输出信号用于控制驱动电路(10)；
对地红外防跌落电路(8)由四对红外发射、接收管采集信号，其输出信号经放大后接入微处理器A(1)的脚40、脚7、脚5、脚8，输出信号用于控制驱动电路(10)；
导航电路(9)由四对红外发射、接收管和二对霍尔传感器采集信号，输出信号经多路切换电路U4后输出到运算放大器U2进行信号处理，处理过的信号经运算放大器U2的脚7输出至A/D转换器(3)的脚14进行A/D转换，转换后的数字信号进入微处理器A(1)进行处理，输出信号用于控制驱动电路(10)；
驱动电路(10)接受微处理器A(1)的控制，由第一四位数值比较器U9、第二四位数值比较器U10，电机驱动器U11和晶振电路U8组成，第一四位数值比较器U9、第二四位数值比较器U10取样电平由晶振电路U8的脚3、脚4、脚5、脚6在4M晶振分频后得到，电机驱动器U11的输出信号分别控制两个减速电机的方向和速度。
CNB2006100521729A 2006-06-27 2006-06-27 一种机器人智能控制装置 Expired - Fee Related CN100398271C (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CNB2006100521729A CN100398271C (zh) 2006-06-27 2006-06-27 一种机器人智能控制装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CNB2006100521729A CN100398271C (zh) 2006-06-27 2006-06-27 一种机器人智能控制装置

Publications (2)

Publication Number Publication Date
CN1895857A CN1895857A (zh) 2007-01-17
CN100398271C true CN100398271C (zh) 2008-07-02

Family

ID=37608572

Family Applications (1)

Application Number Title Priority Date Filing Date
CNB2006100521729A Expired - Fee Related CN100398271C (zh) 2006-06-27 2006-06-27 一种机器人智能控制装置

Country Status (1)

Country Link
CN (1) CN100398271C (zh)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105841735A (zh) * 2015-01-12 2016-08-10 芋头科技（杭州）有限公司 机器人的用空气质量检测系统及检测方法
CN105823552A (zh) * 2016-05-06 2016-08-03 简燕梅 建筑结构振动智能检测机器人小车

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1034437A (zh) * 1987-10-23 1989-08-02 三菱重工业株式会社 工业机器人的控制系统
US5369347A (en) * 1992-03-25 1994-11-29 Samsung Electronics Co., Ltd. Self-driven robotic cleaning apparatus and driving method thereof
CN1299991A (zh) * 1999-11-30 2001-06-20 索尼公司 机器人装置控制装置、机器人装置控制方法及存储媒体
CN2510249Y (zh) * 2001-11-06 2002-09-11 海信集团有限公司 清洁机器人
US6603465B1 (en) * 1996-09-06 2003-08-05 Fanuc Ltd. Robot controller
JP2005031778A (ja) * 2003-07-08 2005-02-03 Omron Corp セーフティコントローラおよびそれを用いたシステム
CN1745987A (zh) * 2004-09-10 2006-03-15 中国科学院自动化研究所 一种移动机械手控制系统
CN2923223Y (zh) * 2006-06-27 2007-07-18 浙江大学 一种机器人智能控制装置

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1034437A (zh) * 1987-10-23 1989-08-02 三菱重工业株式会社 工业机器人的控制系统
US5369347A (en) * 1992-03-25 1994-11-29 Samsung Electronics Co., Ltd. Self-driven robotic cleaning apparatus and driving method thereof
US6603465B1 (en) * 1996-09-06 2003-08-05 Fanuc Ltd. Robot controller
CN1299991A (zh) * 1999-11-30 2001-06-20 索尼公司 机器人装置控制装置、机器人装置控制方法及存储媒体
CN2510249Y (zh) * 2001-11-06 2002-09-11 海信集团有限公司 清洁机器人
JP2005031778A (ja) * 2003-07-08 2005-02-03 Omron Corp セーフティコントローラおよびそれを用いたシステム
CN1745987A (zh) * 2004-09-10 2006-03-15 中国科学院自动化研究所 一种移动机械手控制系统
CN2923223Y (zh) * 2006-06-27 2007-07-18 浙江大学 一种机器人智能控制装置

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
基于红外传感器的机器人辅助控制. 曹晟赟，陈万米，曹中杰.2005年中国机器人大赛论文集. 2005
基于红外传感器的机器人辅助控制. 曹晟赟，陈万米，曹中杰.2005年中国机器人大赛论文集. 2005 *

Also Published As

Publication number Publication date
CN1895857A (zh) 2007-01-17

Similar Documents

Publication Publication Date Title
CN101436039A (zh) 一种智能割草机器人控制系统
KR0140499B1 (ko) 청소기와 그 제어방법
CN100474352C (zh) 道路交通监测系统
CN208095198U (zh) 智能割草机
CN109794945A (zh) 一种用于建筑结构探伤的自动敲击机器人检测系统
CN206578809U (zh) 一种基于rfid定位的室内移动机器人系统
CN100398271C (zh) 一种机器人智能控制装置
CN206306124U (zh) 一种智能跟踪机器人
CN2923223Y (zh) 一种机器人智能控制装置
CN201319581Y (zh) 他励电机控制器
CN201489332U (zh) 一种自动管道清洁机器的电子控制装置
CN202337258U (zh) 一种智能汽车避障控制装置
CN112027399A (zh) 一种多功能智能清洁垃圾桶
CN203232272U (zh) 一种智能割草机器人控制系统
CN201182712Y (zh) 一种智能残障人护理机器人控制系统
CN205126119U (zh) 一种智能清洁机器人
CN209938945U (zh) 一种空气质量检测用无人飞机
CN109444966B (zh) 一种墙体内金属探测仪
CN101530366A (zh) 一种智能排泄物处理机器人控制系统
CN204375168U (zh) 一种基于超声波测速的车辆弯道超速预警装置
CN208515785U (zh) 一种代步车控制器
CN207037933U (zh) 一种停车单元停车饱和度检测的vms预告装置
CN210998676U (zh) 一种基于Arduino的垃圾收理机器人
CN202410838U (zh) 电除尘器阳极振打智能化监测控制装置
CN208481266U (zh) 一种房屋死角自主清洁装置

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C14 Grant of patent or utility model
GR01 Patent grant
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
ASS Succession or assignment of patent right

Owner name: HANGZHOU YINAO INTELLIGENT TECHNOLOGY CO., LTD.

Free format text: FORMER OWNER: ZHEJIANG UNIVERSITY

Effective date: 20120709

C41 Transfer of patent application or patent right or utility model
COR Change of bibliographic data

Free format text: CORRECT: ADDRESS; FROM: 310027 HANGZHOU, ZHEJIANG PROVINCE TO: 310013 HANGZHOU, ZHEJIANG PROVINCE

TR01 Transfer of patent right

Effective date of registration: 20120709

Address after: 310013, E, building 11, Paradise Software Park, 3 West Road, Hangzhou, Zhejiang, Xihu District

Patentee after: Hangzhou Yinao Intelligent Technology Co., Ltd.

Address before: 310027 Hangzhou, Zhejiang Province, Xihu District, Zhejiang Road, No. 38, No.

Patentee before: Zhejiang University

CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20080702

Termination date: 20140627

EXPY Termination of patent right or utility model