CN107422738B - 机器人控制电路 - Google Patents

机器人控制电路 Download PDF

Info

Publication number
CN107422738B
CN107422738B CN201710707453.1A CN201710707453A CN107422738B CN 107422738 B CN107422738 B CN 107422738B CN 201710707453 A CN201710707453 A CN 201710707453A CN 107422738 B CN107422738 B CN 107422738B
Authority
CN
China
Prior art keywords
resistor
capacitor
triode
pin
respectively connected
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.)
Active
Application number
CN201710707453.1A
Other languages
English (en)
Other versions
CN107422738A (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.)
SHENZHEN SUNSOM AUTOMATION EQUIPMENT CO Ltd
Original Assignee
SHENZHEN SUNSOM AUTOMATION EQUIPMENT CO Ltd
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 SHENZHEN SUNSOM AUTOMATION EQUIPMENT CO Ltd filed Critical SHENZHEN SUNSOM AUTOMATION EQUIPMENT CO Ltd
Priority to CN201710707453.1A priority Critical patent/CN107422738B/zh
Publication of CN107422738A publication Critical patent/CN107422738A/zh
Application granted granted Critical
Publication of CN107422738B publication Critical patent/CN107422738B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/0088Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots characterized by the autonomous decision making process, e.g. artificial intelligence, predefined behaviours
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Electromagnetism (AREA)
  • Business, Economics & Management (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Evolutionary Computation (AREA)
  • Game Theory and Decision Science (AREA)
  • Medical Informatics (AREA)
  • Toys (AREA)

Abstract

本发明提供的机器人控制电路包括有视觉模块和连接在指示模块上的左电机模块、右电机模块,左电机模块、右电机模块与控制模块连接,所述视觉模块包括有控制芯片、第一复合三极管、第一电阻、第二电阻等元件构成,本方案采用两个小型直流电动机使机器人能迂回行走。使机器人具有一定的智能功能,能判断眼前有无障碍物,当右眼前方出现障碍物时,就向左行;当左眼前方出现障碍物时,就向右行;当左右两眼前方同时出现障碍物时,机器人就回行。

Description

机器人控制电路
技术领域
本发明涉及机器人技术领域,尤其是指机器人控制电路。
背景技术
现有的玩具机器人大多需要通过手柄来控制行走,控制不当时会撞上障碍物,大大影响机器人的操作体验。
发明内容
本发明的目的在于克服现有技术的不足,提供一种使用效果好的机器人控制电路。
为实现上述目的,本发明所提供的技术方案为:机器人控制电路,它包括有视觉模块和连接在指示模块上的左电机模块、右电机模块,左电机模块、右电机模块与控制模块连接,所述视觉模块包括有控制芯片、第一复合三极管、第一电阻、第二电阻,其中,控制芯片的第1脚分别与第一电阻、第二电阻一端连接,第二电阻另一端与控制芯片的第2脚、第一电容一端相连接,第一电容另一端与第一电解电容一端连接后再依次与控制芯片第7脚、第一复合三极管射极、第一电位器、第三复合三极管射极、第二电位器、第九电阻一端连接后与第五复合三极管射极连接;第一电解电容另一端与第一电阻另一端连接后与控制芯片的第4脚、第14脚、第四发光二极管、第二光栅三极管、第六电阻、第五发光二极管、第四光栅三极管、第十电阻一端连接;控制芯片的第5脚与第一复合三极管基极连接,第四发光二极管另一端与第三电阻一端连接,第三电阻另一端与第一复合三极管集极连接后依次与第四电阻、第七电阻一端相连接,第一电位器另一端分别与第二电容一端、第二光栅三极管另一端相连接,第二电容另一端分别与第四电阻另一端、第三复合三极管基极相连接,第六电阻另一端分别与左电机模块、第三复合三极管集极相连接,第五发光二极管另一端与第七电阻另一端连接,第四光栅三极管另一端分别与第十电容、第二电位器相连接,第十电容另一端分别与第五复合三极管基极、第九电阻另一端相连接,第十电阻另一端分别与第五复合三极管集极、右电机模块相连接;
右电机模块包括有右电机、第一开关、第一二极管、芯片,其中,芯片第8脚分别与视觉模块、第三电容一端相连接,芯片第13脚、第12脚互连后分别与第三电位器一端、第四电解电容一端连接,第三电位器另一端依次与芯片第10脚、第一开关、第一二极管、右电机连接后与左电机模块相连接;芯片的第 12 引脚和第 13 引脚互连后连接第四电解电容一端,第六电容一端连接芯片,另一端连接第四电解电容 的另一端;第四电解电容另一端接地并依次与第三电容另一端、第六电容另一端、第六复合三极管射极连接后与左电机模块相连接;芯片第9脚与第十二电阻一端相连接,第十二电阻另一端与第六复合三极管基极连接,第一二极管另一端与第一开关、第六复合三极管集极连接后与控制模块连接;
控制模块包括有第十电感电容、第八复合三极管、第十四电阻,其中,第十电感电容一端分别与右电机模块、第九复合三极管集极、第十复合三极管集极相连接,第十电感电容另一端分别与第十六电阻、第十五电阻一端相连接,第十五电阻另一端与第八电阻一端相连接,第八电阻另一端分别与第三二极管一端、第八复合三极管集极相连接,第十六电阻另一端分别与第十四电阻一端、第八复合三极管基极相连接,第十四电阻另一端与左电机模块相连接,第八复合三极管射极接地并依次与第十一电感电容一端、第十三电阻一端、第十复合三极管射极相连接,第三二极管另一端分别与第十一电感电容另一端、第十一电阻一端相连接,第十一电阻另一端分别与第十三电阻另一端、第九复合三极管基极相连接,第九复合三极管射极与第十复合三极管基极连接。
本方案所述的电路是一个玩具机器人控制电路,它采用了两个小型直流电动机使机器人能迂回行走。该机器人具有一定的智能功能,能判断眼前有无障碍物,当右眼前方出现障碍物时,就向左行;当左眼前方出现障碍物时,就向右行;当左右两眼前方同时出现障碍物时,机器人就回行。该机器人用于娱乐场所,很受儿童欢迎。
附图说明
图1为本发明的整体结构示意图。
实施方式
下面结合所有附图对本发明作进一步说明,本发明的较佳实施例为:参见附图1,本实施例所述的机器人控制电路包括有视觉模块和连接在指示模块上的左电机模块、右电机模块,左电机模块、右电机模块与控制模块连接,所述视觉模块包括有控制芯片IC1、第一复合三极管VT1、第一电阻R1、第二电阻R2,其中,控制芯片IC1的第1脚分别与第一电阻R1、第二电阻R2一端连接,第二电阻R2另一端与控制芯片IC1的第2脚、第一电容C1一端相连接,第一电容C1另一端与第一电解电容C1-1一端连接后再依次与控制芯片IC1第7脚、第一复合三极管VT1射极、第一电位器RP1、第三复合三极管VT3射极、第二电位器RP2、第九电阻R9一端连接后与第五复合三极管VT5射极连接;第一电解电容C1-1另一端与第一电阻R1另一端连接后与控制芯片IC1的第4脚、第14脚、第四发光二极管VD4、第二光栅三极管VT2、第六电阻R6、第五发光二极管VD5、第四光栅三极管VT4、第十电阻R10一端连接;控制芯片IC1的第5脚与第一复合三极管VT1基极连接,第四发光二极管VD4另一端与第三电阻R3一端连接,第三电阻R3另一端与第一复合三极管VT1集极连接后依次与第四电阻R3-1、第七电阻R7一端相连接,第一电位器RP1另一端分别与第二电容C2一端、第二光栅三极管VT2另一端相连接,第二电容C2另一端分别与第四电阻R3-1另一端、第三复合三极管VT3基极相连接,第六电阻R6另一端分别与左电机模块、第三复合三极管VT3集极相连接,第五发光二极管VD5另一端与第七电阻R7另一端连接,第四光栅三极管VT4另一端分别与第十电容C10、第二电位器RP2相连接,第十电容C10另一端分别与第五复合三极管VT5基极、第九电阻R9另一端相连接,第十电阻R10另一端分别与第五复合三极管VT5集极、右电机模块相连接;
左、右电机模块原理相同,右电机模块包括有右电机、第一开关K1、第一二极管VD1、芯片CV,其中,芯片CV第8脚分别与视觉模块、第三电容C3一端相连接,芯片CV第13脚、第12脚互连后分别与第三电位器RP3一端、第四电解电容C4一端连接,第三电位器RP3另一端依次与芯片CV第10脚、第一开关K1、第一二极管VD1、右电机连接后与左电机模块相连接;芯片 CV 的第 12 引脚和第 13 引脚互连后连接第四电解电容 C4 一端,第六电容 C6 一端连接芯片 CV,另一端连接第四电解电容 C4 的另一端,第四电解电容C4另一端接地并依次与第三电容C3另一端、第六电容C6另一端、第六复合三极管VT6射极连接后与左电机模块相连接;芯片CV第9脚与第十二电阻R12一端相连接,第十二电阻R12另一端与第六复合三极管VT6基极连接,第一二极管VD1另一端与第一开关K1、第六复合三极管VT6集极连接后与控制模块连接;
控制模块包括有第十电感电容C10、第八复合三极管VT8、第十四电阻R14,其中,第十电感电容C10一端分别与右电机模块、第九复合三极管VT9集极、第十复合三极管VT10集极相连接,第十电感电容C10另一端分别与第十六电阻R16、第十五电阻R15一端相连接,第十五电阻R15另一端与第八电阻R8一端相连接,第八电阻R8另一端分别与第三二极管VD3一端、第八复合三极管VT8集极相连接,第十六电阻R16另一端分别与第十四电阻R14一端、第八复合三极管VT8基极相连接,第十四电阻R14另一端与左电机模块相连接,第八复合三极管VT8射极接地并依次与第十一电感电容C11一端、第十三电阻R13一端、第十复合三极管VT10射极相连接,第三二极管VD3另一端分别与第十一电感电容C11另一端、第十一电阻R11一端相连接,第十一电阻R11另一端分别与第十三电阻R13另一端、第九复合三极管VT9基极相连接,第九复合三极管VT9射极与第十复合三极管VT10基极连接。
所述的两个电动机分别安装在机器左右两侧的下方,机器人的行走方向与每个电动机的旋转方向有关。当使两个电动机都朝同一方向旋转时,机器人可以前进或倒退。此外,当一个电动机正转,而另一个电动机反转时,机器人也可以原地转弯。当左电机正转(前进方向),右电动机反转(后退方向)时,机器人就向右行。通过采用了两个小型直流电动机使机器人能迂回行走。使机器人具有一定的智能功能,能判断眼前有无障碍物,本方案机器人用于娱乐场所,很受儿童欢迎。
以上所述之实施例只为本发明之较佳实施例,并非以此限制本发明的实施范围,故凡依本发明之形状、原理所作的变化,均应涵盖在本发明的保护范围内。

Claims (1)

1.机器人控制电路,其特征在于:它包括有视觉模块和连接在指示模块上的左电机模块、右电机模块,左电机模块、右电机模块与控制模块连接,所述视觉模块包括有控制芯片(IC1)、第一复合三极管(VT1)、第一电阻(R1)、第二电阻(R2),其中,控制芯片(IC1)的第1脚分别与第一电阻(R1)、第二电阻(R2)一端连接,第二电阻(R2)另一端与控制芯片(IC1)的第2脚、第一电容(C1)一端相连接,第一电容(C1)另一端与第一电解电容(C1-1)一端连接后再依次与控制芯片(IC1)第7脚、第一复合三极管(VT1)射极、第一电位器(RP1)、第三复合三极管(VT3)射极、第二电位器(RP2)、第九电阻(R9)一端连接后与第五复合三极管(VT5)射极连接;第一电解电容(C1-1)另一端与第一电阻(R1)另一端连接后与控制芯片(IC1)的第4脚、第14脚、第四发光二极管(VD4)、第二光栅三极管(VT2)、第六电阻(R6)、第五发光二极管(VD5)、第四光栅三极管(VT4)、第十电阻(R10)一端连接;控制芯片(IC1)的第5脚与第一复合三极管(VT1)基极连接,第四发光二极管(VD4)另一端与第三电阻(R3)一端连接,第三电阻(R3)另一端与第一复合三极管(VT1)集极连接后依次与第四电阻(R3-1)、第七电阻(R7)一端相连接,第一电位器(RP1)另一端分别与第二电容(C2)一端、第二光栅三极管(VT2)另一端相连接,第二电容(C2)另一端分别与第四电阻(R3-1)另一端、第三复合三极管(VT3)基极相连接,第六电阻(R6)另一端分别与左电机模块、第三复合三极管(VT3)集极相连接,第五发光二极管(VD5)另一端与第七电阻(R7)另一端连接,第四光栅三极管(VT4)另一端分别与第十电容(C10)、第二电位器(RP2)相连接,第十电容(C10)另一端分别与第五复合三极管(VT5)基极、第九电阻(R9)另一端相连接,第十电阻(R10)另一端分别与第五复合三极管(VT5)集极、右电机模块相连接;
右电机模块包括有右电机、第一开关(K1)、第一二极管(VD1)、芯片(CV),其中,芯片(CV)第8脚分别与视觉模块、第三电容(C3)一端相连接,芯片(CV)第13脚、第12脚互连后分别与第三电位器(RP3)一端、第四电解电容(C4)一端连接,第三电位器(RP3)另一端依次与芯片(CV)第10脚、第一开关(K1)、第一二极管(VD1)、右电机连接后与左电机模块相连接;芯片( CV )的第 12 引脚和第 13 引脚互连后连接第四电解电容 (C4)一端,第六电容(C6)一端连接芯片(CV),另一端连接第四电解电容(C4)的另一端;第四电解电容(C4)另一端接地并依次与第三电容(C3)另一端、第六电容(C6)另一端、第六复合三极管(VT6)射极连接后与左电机模块相连接;芯片(CV)第9脚与第十二电阻(R12)一端相连接,第十二电阻(R12)另一端与第六复合三极管(VT6)基极连接,第一二极管(VD1)另一端与第一开关(K1)、第六复合三极管(VT6)集极连接后与控制模块连接;
控制模块包括有第十电感电容(C10)、第八复合三极管(VT8)、第十四电阻(R14),其中,第十电感电容(C10)一端分别与右电机模块、第九复合三极管(VT9)集极、第十复合三极管(VT10)集极相连接,第十电感电容(C10)另一端分别与第十六电阻(R16)、第十五电阻(R15)一端相连接,第十五电阻(R15)另一端与第八电阻(R8)一端相连接,第八电阻(R8)另一端分别与第三二极管(VD3)一端、第八复合三极管(VT8)集极相连接,第十六电阻(R16)另一端分别与第十四电阻(R14)一端、第八复合三极管(VT8)基极相连接,第十四电阻(R14)另一端与左电机模块相连接,第八复合三极管(VT8)射极接地并依次与第十一电感电容(C11)一端、第十三电阻(R13)一端、第十复合三极管(VT10)射极相连接,第三二极管(VD3)另一端分别与第十一电感电容(C11)另一端、第十一电阻(R11)一端相连接,第十一电阻(R11)另一端分别与第十三电阻(R13)另一端、第九复合三极管(VT9)基极相连接,第九复合三极管(VT9)射极与第十复合三极管(VT10)基极连接。
CN201710707453.1A 2017-08-17 2017-08-17 机器人控制电路 Active CN107422738B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710707453.1A CN107422738B (zh) 2017-08-17 2017-08-17 机器人控制电路

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710707453.1A CN107422738B (zh) 2017-08-17 2017-08-17 机器人控制电路

Publications (2)

Publication Number Publication Date
CN107422738A CN107422738A (zh) 2017-12-01
CN107422738B true CN107422738B (zh) 2023-06-30

Family

ID=60438276

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710707453.1A Active CN107422738B (zh) 2017-08-17 2017-08-17 机器人控制电路

Country Status (1)

Country Link
CN (1) CN107422738B (zh)

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN205281259U (zh) * 2016-01-06 2016-06-01 金陵科技学院 基于机械手的运动控制器

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN2384658Y (zh) * 1999-08-19 2000-06-28 卢增亮 电动玩具车
CN101442283A (zh) * 2007-11-23 2009-05-27 沈阳新松机器人自动化股份有限公司 一种基于dsp的双电机同步伺服驱动装置
CN102242717B (zh) * 2010-05-14 2013-09-25 于佳衣 一种一体化及液体润滑永磁无刷直流电机电动水泵
CN202084240U (zh) * 2011-05-25 2011-12-21 杭州奕阳教育服务有限公司 简易机器人
CN103455822B (zh) * 2013-08-19 2016-10-19 江苏科技大学 复杂工业环境中的巡检机器人系统及多人脸动态跟踪方法
US9517559B2 (en) * 2013-09-27 2016-12-13 Honda Motor Co., Ltd. Robot control system, robot control method and output control method
CA2882968C (en) * 2015-02-23 2023-04-25 Sulfur Heron Cognitive Systems Inc. Facilitating generation of autonomous control information

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN205281259U (zh) * 2016-01-06 2016-06-01 金陵科技学院 基于机械手的运动控制器

Also Published As

Publication number Publication date
CN107422738A (zh) 2017-12-01

Similar Documents

Publication Publication Date Title
CN103569235B (zh) 五关节仿蛙跳跃机器人
CN106828651B (zh) 一种可变形的轮足运动机器人
CN103991487B (zh) 全气动真空吸附式爬壁机器人
CN104511906B (zh) 多关节机械手
CN102991601A (zh) 一种两自由度仿人踝部关节
CN107422738B (zh) 机器人控制电路
CN107298137A (zh) 一种趴卧式步行机器人
CN105013182A (zh) 轮足可变胞玩具机器人
CN106218749A (zh) 一种新型半被动行走的跨障装置及其控制方法
CN105015642A (zh) 由单电机驱动的半被动行走器及其转向控制方法
CN108516024A (zh) 一种仿虫特种机器人及其控制方法
CN109159830A (zh) 一种轮腿结合式机器人
CN205097176U (zh) 一种夹持与轮滚结合的机器人末端模块
CN203471788U (zh) 多关节机械手
CN203902715U (zh) 全气动真空吸附式爬壁机器人
CN107813290A (zh) 串并混联机械臂
CN201598582U (zh) 自动伸缩挡杆
CN106080832A (zh) 半被动行走装置及其控制方法
CN113492932A (zh) 一种面向非结构环境下的脊柱型仿生四足机器人及运行方法
CN110360406A (zh) 一种蠕动式管道机器人
CN106608308A (zh) 一种机器人
CN110368212A (zh) 轮椅
CN107116538B (zh) 一种三转动一移动广义解耦并联机器人机构
CN106863302B (zh) 一种机器人充电装置及其实现方法
CN105922245B (zh) 基于扭转传动的蠕虫式伸缩行进装置

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
TA01 Transfer of patent application right

Effective date of registration: 20230601

Address after: Building 101, No.1 San Road, San Industrial Zone, Bitou Community, Songgang Street, Bao'an District, Shenzhen City, Guangdong Province, 518000

Applicant after: SHENZHEN SUNSOM AUTOMATION EQUIPMENT CO.,LTD.

Address before: 413000 Building D6, Zone D, Single story Standardized Factory Building, East Industrial Park, High tech Zone, Yiyang City, Hunan Province

Applicant before: HUNAN XUCHONG INTELLIGENT EQUIPMENT IND Co.,Ltd.

TA01 Transfer of patent application right
GR01 Patent grant
GR01 Patent grant