基于加速度传感器的机器人行为检测系统及方法.pdf

(19)中华人民共和国国家知识产权局(12)发明专利申请(10)申请公布号CN106568440A(43)申请公布日2017.04.19(21)申请号201610959103.X(22)申请日2016.11.03(71)申请人珠海市一微半导体有限公司地址519000广东省珠海市香洲区横琴新区宝华路6号105室—514(72)发明人戴剑锋(74)专利代理机构广东朗乾律师事务所44291代理人闫有幸杨焕军(51)Int.Cl.G01C21/16(2006.01)权利要求书1页说明书3页附图3页(54)发明名称基于加速度传感器的机器人行为检测系统及方法(57)摘要本发明公开一种基于加速度传感器的机器人行为检测系统及方法，通过配置加速度检测装置并利用特定的检测分析步骤，即可实现对机器人轮子打滑、碰撞等行为的检测，为机器人行为控制策略提供相关的依据。本发明使得机器人的结构设计简化，降低了模具跟电子元件的成本，保证机器人外观美观，增加机器人的可靠性，功能使用寿命长。CN106568440ACN106568440A权利要求书1/1页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,该两个值根据实际的机器人运行情况进行设定和调整。2CN106568440A说明书1/3页基于加速度传感器的机器人行为检测系统及方法【技术领域】[0001]本发明涉及智能机器人技术领域，具体涉及一种机器人行为(运行状态)检测系统及方法。【背景技术】[0002]生活水平的提高，越来越多人渴望得到更多的个人休闲时间，以便享受生活。随着科学技术的发展，机器人可以逐步代替人类承担简单重复的体力劳动。这些机器人很多都必须具备自主行走运动能力，而这类机器人的运动环境比较复杂，常常会导致机器人出现异常的情况。例如，机器人在行动过程中会遇到比较小的障碍物、比较高的门槛、比较窄小的空间等，针对这些情况，一般的做法都需要通过设计一些比较复杂的结构来检测机器人的运行状态。[0003]目前，市面上的移动机器人为了检测障碍物跟打滑，一般结构都包括碰撞检测机构(检测是否碰撞障碍物)、万向轮检测机构(检测轮子是否打滑)。这就会导致机器人的结构设计复杂，开发模具费用过高，电子元件的成本高，外观不够美观，而且也导致机器人容易出现故障(比如碰撞部分的元件出现问题)，万向轮脏了导致不能检测出打滑。【发明内容】[0004]本发明旨在实现对机器人的碰撞、打滑、正常运行等行为的检测的同时，简化机器人的结构设计简化，降低模具跟电子元件的成本，增加机器人的可靠性。本发明的目的由以下技术方案实现：[0005]一种基于加速度传感器的机器人行为检测系统，所述机器人包括机壳、运动系统、控制主板；其特征在于，所