CN106568440A - 基于加速度传感器的机器人行为检测***及方法 - Google Patents
基于加速度传感器的机器人行为检测***及方法 Download PDFInfo
- Publication number
- CN106568440A CN106568440A CN201610959103.XA CN201610959103A CN106568440A CN 106568440 A CN106568440 A CN 106568440A CN 201610959103 A CN201610959103 A CN 201610959103A CN 106568440 A CN106568440 A CN 106568440A
- Authority
- CN
- China
- Prior art keywords
- accel
- value
- time
- robot
- buffer
- 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
- 230000001133 acceleration Effects 0.000 title claims abstract description 33
- 238000001514 detection method Methods 0.000 title claims abstract description 16
- 238000000034 method Methods 0.000 title abstract description 11
- 230000006399 behavior Effects 0.000 claims description 21
- 230000003542 behavioural effect Effects 0.000 claims description 7
- 230000001186 cumulative effect Effects 0.000 claims description 5
- 230000010365 information processing Effects 0.000 claims description 5
- 230000008859 change Effects 0.000 claims description 3
- 230000010354 integration Effects 0.000 claims description 3
- 238000013461 design Methods 0.000 abstract description 4
- 238000011217 control strategy Methods 0.000 abstract description 2
- 238000011895 specific detection Methods 0.000 abstract 1
- 230000004888 barrier function Effects 0.000 description 2
- 230000033001 locomotion Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000002159 abnormal effect Effects 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 238000013499 data model Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000005670 electromagnetic radiation Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 230000035922 thirst Effects 0.000 description 1
- 230000032258 transport Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Toys (AREA)
- Manipulator (AREA)
Abstract
本发明公开一种基于加速度传感器的机器人行为检测***及方法，通过配置加速度检测装置并利用特定的检测分析步骤，即可实现对机器人轮子打滑、碰撞等行为的检测，为机器人行为控制策略提供相关的依据。本发明使得机器人的结构设计简化，降低了模具跟电子元件的成本，保证机器人外观美观，增加机器人的可靠性，功能使用寿命长。
Description
【技术领域】
本发明涉及智能机器人技术领域，具体涉及一种机器人行为(运行状态)检测***及方法。
【背景技术】
生活水平的提高，越来越多人渴望得到更多的个人休闲时间，以便享受生活。随着科学技术的发展，机器人可以逐步代替人类承担简单重复的体力劳动。这些机器人很多都必须具备自主行走运动能力，而这类机器人的运动环境比较复杂，常常会导致机器人出现异常的情况。例如，机器人在行动过程中会遇到比较小的障碍物、比较高的门槛、比较窄小的空间等，针对这些情况，一般的做法都需要通过设计一些比较复杂的结构来检测机器人的运行状态。
目前，市面上的移动机器人为了检测障碍物跟打滑，一般结构都包括碰撞检测机构(检测是否碰撞障碍物)、万向轮检测机构(检测轮子是否打滑)。这就会导致机器人的结构设计复杂，开发模具费用过高，电子元件的成本高，外观不够美观，而且也导致机器人容易出现故障(比如碰撞部分的元件出现问题)，万向轮脏了导致不能检测出打滑。
【发明内容】
本发明旨在实现对机器人的碰撞、打滑、正常运行等行为的检测的同时，简化机器人的结构设计简化，降低模具跟电子元件的成本，增加机器人的可靠性。本发明的目的由以下技术方案实现：
一种基于加速度传感器的机器人行为检测***，所述机器人包括机壳、运动***、控制主板；其特征在于，所述行为检测***由加速度检测装置实现，加速度检测装置包括加速度传感器和加速度数据处理单元，加速度数据处理单元的输出连接控制主板的行为检测数据输入端。
作为具体的技术方案，所述运动***包括：可以由马达驱动改变方向的轮子、驱动马达和万向轮。
作为具体的技术方案，所述控制主板设置于机壳内，所述加速度检测装置设置于主板上并远离所述驱动马达。
一种基于上述行为检测***的检测方法，包括：
将T时间内采集的数据绝对值进行累加积分ACCEL_SUM，同时记录T时间内绝对值超过阈值ACCEL的时间间隔存储到数组Time_buffer[]，根据公式1对累加的ACCEL_SUM取平均值；
ACCEL_AVERAGE＝ACCEL_SUM/T(公式1)
结合Time_buffer[]和ACCEL_AVERAGE的值进行分析就可以对机器的三种行为进行判断，具体如下：
当Time_buffer[]里面存储的数据个数为0，并且ACCEL_AVERAGE的数据小于值ACCEL_Data0时，则判断机器处于打滑状态；
当Time_buffer[]里面存储的数据个数大于1，并且相邻的数据差值小于t0，则可以判断机器在这段时间内频繁碰撞，并且ACCEL_AVERAGE的数据大于值ACCEL_Data2时则判断机器处于碰撞状态；
当Time_buffer[]里面存储的数据个数等于0，并且ACCEL_AVERAGE的数据大于值ACCEL_Data1小于值ACCEL_Data2时则判断机器处于正常运行状态；或者当Time_buffer[]里面存储的数据个数大于等于1时，Time_buffer[0]值大于t1,并且相邻的数据差值大于t1，则也认为机器处于正常运行状态；
其中，ACCEL_Data2>ACCEL_Data1>ACCEL_Data0,该三个值根据实际的机器人运行情况进行设定和调整；t1>t0,该两个值根据实际的机器人运行情况进行设定和调整。
本发明提供的机器人行为检测***及方法，仅通过加速度检测装置并配置特定的检测分析步骤，即可实现对机器人轮子打滑、碰撞等行为的检测，为机器人行为控制策略提供相关的依据。本发明使得机器人的结构设计简化，降低了模具跟电子元件的成本，保证机器人外观美观，增加机器人的可靠性，功能使用寿命长。
【附图说明】
图1为应用本发明实施例提供的检测方法的机器人的硬件***。
图2为本发明实施例提供的检测方法的检测流程图。
图3A、3B、3C分别为应用本发明实施例提供的检测方法的机器人在空旷空间内运动偶尔发生碰撞行为、在狭小空间内运动不断发生碰撞行为、轮子打滑行为对应的加速度数据样板。
【具体实施方式】
以下结合附图对本发明的实施例进行详细说明。
本发明的机器人行为检测***硬件框架如图1所示，其中机器人底座4跟机器人的外壳5固定在一起，构成机壳。机器人的运动***包括如下组件：可以由马达驱动改变方向的轮子1、驱动马达和万向轮6，万向轮6为非必要器件，可以由其他支撑作用的器件替代。控制主板2设置于机壳内，通过主板程序控制轮子向前向后向左向右运动。加速度检测装置安装于机器人主板的中心位置，以避免机器的抖动造成对加速度传感器的影响，另外加速度传感器要尽量远离轮子的驱动马达，避免马达的电磁辐射对其造成影响。加速度检测装置包括加速度传感器和加速度数据处理单元，加速度传感器可以为三轴加速度传感器，加速度数据处理单元对加速度传感器采集的数据进行处理，其输出连接控制主板的行为检测数据输入端。
图2是通过采集加速度检测装置的数据对机器人行为进行检测的流程，在机器人运动的过程中，不断采集加速度检测装置的数据并进行分析，通过分析可以得到机器人三种运动状态，分别是：正常运行状态、碰撞状态及打滑状态。
假设采集数据的时间长度为T,将T时间内采集的数据绝对值进行累加积分ACCEL_SUM，同时记录T时间内绝对值超过阈值ACCEL的时间间隔存储到数组Time_buffer[]，对累加的ACCEL_SUM取平均值(如公式1)。
ACCEL_AVERAGE＝ACCEL_SUM/T(公式1)
结合Time_buffer[]和ACCEL_AVERAGE的值进行分析就可以对机器的三种行为进行判断，具体如下：
当Time_buffer[]里面存储的数据个数为0，并且ACCEL_AVERAGE的数据小于值ACCEL_Data0时，则判断机器处于打滑状态。
当Time_buffer[]里面存储的数据个数大于1，并且相邻的数据差值小于t0，则可以判断机器在这段时间内频繁碰撞，并且ACCEL_AVERAGE的数据大于值ACCEL_Data2时则判断机器处于碰撞状态。
当Time_buffer[]里面存储的数据个数等于0，并且ACCEL_AVERAGE的数据大于值ACCEL_Data1小于值ACCEL_Data2时则判断机器处于正常运行状态；或者当Time_buffer[]里面存储的数据个数大于等于1时，Time_buffer[0]值大于t1,并且相邻的数据差值大于t1，则也认为机器处于正常运行状态。
如上所述的ACCEL_Data2>ACCEL_Data1>ACCEL_Data0,这三个值需要根据实际的机器人运行情况进行设定和调整；t1>t0,这两个值也需要根据实际的机器运行情况进行调整。
上述判断过程中，机器人在空旷空间内运动偶尔发生碰撞行为、在狭小空间内运动不断发生碰撞行为、轮子打滑行为对应的加速度数据样板分别参见图3A、3B、3C。
上述实施例仅为充分公开而非限制本发明，凡是依据本发明创新主旨且未经创造性劳动即可获得的等效技术特征替换及增减，均应属于本发明揭露的范围。
Claims (4)
1.一种基于加速度传感器的机器人行为检测***，所述机器人包括机壳、运动***、控制主板；其特征在于，所述行为检测***由加速度检测装置实现，加速度检测装置包括加速度传感器和加速度数据处理单元，加速度数据处理单元的输出连接控制主板的行为检测数据输入端。
2.根据权利要求1所述的基于加速度传感器的机器人行为检测***，其特征在于，所述运动***包括：可以由马达驱动改变方向的轮子、驱动马达和万向轮。
3.根据权利要求2所述的基于加速度传感器的机器人行为检测***，其特征在于，所述控制主板设置于机壳内，所述加速度检测装置设置于主板上并远离所述驱动马达。
4.一种基于权利要求1所述行为检测***的检测方法，其特征在于，包括：
将T时间内采集的数据绝对值进行累加积分ACCEL_SUM，同时记录T时间内绝对值超过阈值ACCEL的时间间隔存储到数组Time_buffer[]，根据公式1对累加的ACCEL_SUM取平均值；
ACCEL_AVERAGE＝ACCEL_SUM/T (公式1)
结合Time_buffer[]和ACCEL_AVERAGE的值进行分析就可以对机器的三种行为进行判断，具体如下：
当Time_buffer[]里面存储的数据个数为0，并且ACCEL_AVERAGE的数据小于值ACCEL_Data0时，则判断机器处于打滑状态；
当Time_buffer[]里面存储的数据个数大于1，并且相邻的数据差值小于t0，则可以判断机器在这段时间内频繁碰撞，并且ACCEL_AVERAGE的数据大于值ACCEL_Data2时则判断机器处于碰撞状态；
当Time_buffer[]里面存储的数据个数等于0，并且ACCEL_AVERAGE的数据大于值ACCEL_Data1小于值ACCEL_Data2时则判断机器处于正常运行状态；或者当Time_buffer[]里面存储的数据个数大于等于1时，Time_buffer[0]值大于t1,并且相邻的数据差值大于t1，则也认为机器处于正常运行状态；
其中，ACCEL_Data2>ACCEL_Data1>ACCEL_Data0,该三个值根据实际的机器人运行情况进行设定和调整；t1>t0,该两个值根据实际的机器人运行情况进行设定和调整。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610959103.XA CN106568440A (zh) | 2016-11-03 | 2016-11-03 | 基于加速度传感器的机器人行为检测***及方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201610959103.XA CN106568440A (zh) | 2016-11-03 | 2016-11-03 | 基于加速度传感器的机器人行为检测***及方法 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN106568440A true CN106568440A (zh) | 2017-04-19 |
Family
ID=58535545
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201610959103.XA Pending CN106568440A (zh) | 2016-11-03 | 2016-11-03 | 基于加速度传感器的机器人行为检测***及方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN106568440A (zh) |
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106996989A (zh) * | 2017-05-09 | 2017-08-01 | 北京克路德人工智能科技有限公司 | 一种机器人壳体碰撞检测方法 |
| CN108681325A (zh) * | 2018-05-14 | 2018-10-19 | 珠海市微半导体有限公司 | 机器人基于加速计的仰角检测方法和被卡检测及脱卡方法 |
| CN109032052A (zh) * | 2018-06-26 | 2018-12-18 | 上海常仁信息科技有限公司 | 基于机器人身份证的紧急状况智能控制*** |
| CN109491391A (zh) * | 2018-11-27 | 2019-03-19 | 广东宝乐机器人股份有限公司 | 擦窗机器人的碰撞识别方法和装置 |
| CN111712399A (zh) * | 2019-06-11 | 2020-09-25 | 深圳市大疆创新科技有限公司 | 可移动平台的控制方法、装置、设备及存储介质 |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2010069585A (ja) * | 2008-09-19 | 2010-04-02 | Yaskawa Electric Corp | 衝突検出装置及び方法並びにロボット制御装置 |
| CN105137994A (zh) * | 2015-09-10 | 2015-12-09 | 珠海市一微半导体有限公司 | 机器人障碍物检测***及方法 |
| CN105138017A (zh) * | 2015-08-24 | 2015-12-09 | 铜陵学院 | 基于两轮中速全自动灭火机器人的双核伺服控制*** |
-
2016
- 2016-11-03 CN CN201610959103.XA patent/CN106568440A/zh active Pending
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2010069585A (ja) * | 2008-09-19 | 2010-04-02 | Yaskawa Electric Corp | 衝突検出装置及び方法並びにロボット制御装置 |
| CN105138017A (zh) * | 2015-08-24 | 2015-12-09 | 铜陵学院 | 基于两轮中速全自动灭火机器人的双核伺服控制*** |
| CN105137994A (zh) * | 2015-09-10 | 2015-12-09 | 珠海市一微半导体有限公司 | 机器人障碍物检测***及方法 |
Non-Patent Citations (1)
| Title |
|---|
| 魏延辉等: "基于两轮自平衡机器人组合定位方法的研究", 《机械与电子》 * |
Cited By (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106996989A (zh) * | 2017-05-09 | 2017-08-01 | 北京克路德人工智能科技有限公司 | 一种机器人壳体碰撞检测方法 |
| CN108681325A (zh) * | 2018-05-14 | 2018-10-19 | 珠海市微半导体有限公司 | 机器人基于加速计的仰角检测方法和被卡检测及脱卡方法 |
| CN109032052A (zh) * | 2018-06-26 | 2018-12-18 | 上海常仁信息科技有限公司 | 基于机器人身份证的紧急状况智能控制*** |
| CN109032052B (zh) * | 2018-06-26 | 2020-09-22 | 上海常仁信息科技有限公司 | 基于机器人身份证的紧急状况智能控制*** |
| CN109491391A (zh) * | 2018-11-27 | 2019-03-19 | 广东宝乐机器人股份有限公司 | 擦窗机器人的碰撞识别方法和装置 |
| CN111712399A (zh) * | 2019-06-11 | 2020-09-25 | 深圳市大疆创新科技有限公司 | 可移动平台的控制方法、装置、设备及存储介质 |
| WO2020248132A1 (zh) * | 2019-06-11 | 2020-12-17 | 深圳市大疆创新科技有限公司 | 可移动平台的控制方法、装置、设备及存储介质 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN106568440A (zh) | 基于加速度传感器的机器人行为检测***及方法 | |
| EP3622364B1 (en) | System and method for motion control of a robot | |
| CN111263921B (zh) | 碰撞检测***和计算机实现方法 | |
| CN108582070A (zh) | 机器人碰撞检测***和方法、存储介质、操作*** | |
| CN106339692B (zh) | 一种疲劳驾驶状态信息确定方法及*** | |
| CN1224648A (zh) | 机器人*** | |
| KR102639904B1 (ko) | 공항용 로봇 및 그의 동작 방법 | |
| CN106528075B (zh) | 一种车辆悬架***和调节车辆悬架的方法 | |
| CN106697032A (zh) | 自动婴儿车及其控制方法 | |
| US11529736B2 (en) | Systems, apparatuses, and methods for detecting escalators | |
| CN106055256A (zh) | 游戏技能升级的控制方法及装置 | |
| KR20190106874A (ko) | 인공 지능을 통해 구속 상황을 인식하는 로봇 청소기 및 그의 동작 방법 | |
| US20230172109A1 (en) | Produce Picking Device, System and Method | |
| US20210142061A1 (en) | Mistakenly ingested object identifying robot cleaner and controlling method thereof | |
| CN103886749A (zh) | 一种检测车辆频繁变道行驶的方法及*** | |
| CN109674404A (zh) | 一种基于free move技术的扫地机器人避障处理方式 | |
| KR102531201B1 (ko) | 로봇 청소기 | |
| CN205750377U (zh) | 一种多关节小型机器人电控*** | |
| JP4058031B2 (ja) | ユーザ行動誘発システム及びその方法 | |
| CN106371852A (zh) | 视力保护的提示方法及装置 | |
| KR20200023658A (ko) | 로봇 청소기 | |
| WO2020241223A1 (ja) | 片付け誘引システム、片付け誘引家具及び片付け誘引方法 | |
| EP4070866A1 (en) | Information processing device, information processing method, and information processing program | |
| Browning et al. | CM-Dragons’ 01-Vision-Based Motion Tracking and Heteregenous Robots | |
| CN111056394A (zh) | 数字化轿厢震动检测***及其方法 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| RJ01 | Rejection of invention patent application after publication | ||
| RJ01 | Rejection of invention patent application after publication |
Application publication date: 20170419 |