一种自主机器人的碰撞检测方法、装置及系统的制作方法
【技术领域】
[0001]本申请涉及机器人技术领域，更具体地说，涉及一种自主机器人的碰撞检测方法、装置及系统。
【背景技术】
[0002]随着人们生活水平的不断提高，能够为家庭或其他场所提供辅助工作的自主机器人被越来越多的人所接受。自助机器人在使用过程中或多或少都会遇到碰撞的问题，当发生碰撞后需要及时采取相应的措施避免影响其正常工作，因此对碰撞情况进行及时检测是保证其正常工作的必要前提。
【发明内容】
[0003]有鉴于此，本申请提供一种自主机器人的碰撞检测方法、装置及系统，用于对碰撞情况进行判断，作为其发生碰撞后采取相应措施的依据，以保证其正常工作。
[0004]为了实现上述目的，现提出的方案如下:
[0005]—种自主机器人的碰撞检测方法，包括如下操作:
[0006]对所述自主机器人的加速度数据和角速度数据进行数据融合，得到所述自主机器人的姿态信息；
[0007]对所述加速度数据进行比力换算，得到所述自主机器人的比力信息；
[0008]将所述比力信息进行坐标变换，得到各个轴向的坐标比力信息；
[0009]将所述姿态信息和所述坐标比力信息作为比对依据，将所述比对依据与预设的模糊规则表进行比对得到所述自主机器人的碰撞情况。
[0010]可选的，所述对所述加速度数据和所述角速度数据进行数据融合，包括:
[0011]对所述加速度数据和所述角速度数据进行卡尔曼滤波处理，以进行数据融合。
[0012]可选的，所述将所述比对依据与预设的模糊规则表进行比对得到所述自主机器人的碰撞情况，包括:
[0013]将所述姿态信息与所述模糊规则表的多个预设姿态信息阈值、将所述坐标比力信息与所述模糊规则表的多个预设坐标比力信息阈值分别进行比较，根据比较结果得到所述碰撞情况。
[0014]可选的，所述将所述比力信息进行坐标变换，得到各个轴向的坐标比力信息，包括:
[0015]将所述比力信息进行欧拉角坐标变换，得到大地坐标系下的各个轴向的坐标比力
?目息O
[0016]可选的，还包括:
[0017]根据所述自主机器人的位置信息和所述碰撞情况得到碰撞地点。
[0018]—种自主机器人的碰撞检测装置，包括数据融合模块、比力换算模块、坐标变换模块和查表模块，其中:
[0019]所述数据融合模块用于对所述加速度数据和所述角速度数据进行数据融合，得到所述自主机器人的姿态信息；
[0020]所述比力换算模块对所述加速度数据进行比力换算，得到所述自主机器人的比力信息；
[0021]所述坐标变换模块用于将所述比力信息进行坐标变换，得到各个轴向的坐标比力信息；
[0022]所述查表模块用于将所述姿态信息和所述坐标比力信息作为比对依据，将所述比对依据与预设的模糊规则表进行比对得到所述自主机器人的碰撞情况。
[0023]可选的，所述数据融合模块为卡尔曼滤波模块。
[0024]可选的，所述查表模块用于将所述姿态信息与所述模糊规则表的多个预设姿态信息阈值、将所述坐标比力信息与所述模糊规则表中所列的多个预设坐标比力信息阈值分别进行比较，根据比较结果得到所述碰撞情况。
[0025]可选的，还包括碰撞地点计算模块，其中:
[0026]所述碰撞地点计算模块用于根据所述自主机器人的位置信息和所述碰撞情况得到碰撞地点。
[0027]—种自主机器人的碰撞检测系统，包括惯性传感器和如权利要求6?9任一项所述的碰撞检测装置，其中:
[0028]所述惯性传感器用于获取所述加速度数据和所述角速度数据。
[0029]从上述技术方案可以看出，本申请公开了一种自主机器人的碰撞检测方法、装置及系统，该方法、装置及系统将获取的加速度数据和角速度数据进行计算，通过数据融合得到自主机器人的姿态信息，通过坐标变换得到自主机器人的坐标比力信息，然后根据该姿态信息和坐标比力信息对预设的模糊规则表进行查表操作，从而得到该自主机器人的碰撞情况，进而够根据该碰撞情况采取相应措施，以保证自主机器人能够正常工作。
【附图说明】
[0030]为了更清楚地说明本申请实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本申请的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
[0031]图1为本申请实施例提供的一种自主机器人的碰撞检测方法的流程图；
[0032]图2为本申请另一实施例提供的一种自主机器人的碰撞检测方法的流程图；
[0033]图3为本申请又一实施例提供的一种自主机器人的碰撞检测装置的示意图；
[0034]图4为本申请又一实施例提供的一种自主机器人的碰撞检测装置的示意图；
[0035]图5为本申请又一实施例提供的一种自主机器人的碰撞检测系统的示意图。
【具体实施方式】
[0036]下面将结合本申请实施例中的附图，对本申请实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本申请一部分实施例，而不是全部的实施例。基于本申请中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本申请保护的范围。
[0037]实施例一
[0038]图1为本申请实施例提供的一种自主机器人的碰撞检测方法的流程图。
[0039]如图1所示，本实施例提供的碰撞检测方法包括如下步骤:
[0040]SlOl:计算自主机器人的姿态信息。
[0041]在获取该自主机器人的加速度数据和角速度数据后，将两者进行数据融合，得到自主机器人的姿态信息。
[0042]加速度数据即在三个轴向上的加速度数据，角速度数据为三个轴向上的角速度数据。然后通过卡尔曼滤波算法进行数据融合，从而得到该姿态信息。
[0043]S102:对加速度数据进行比力换算。
[0044]对加速度数据进行比力换算，优选将上述的三个轴向上的加速度数据。进行计算，得到三个轴向上的比力信息。比力等于加速度乘以重力加速度，用于表征在三个轴向上的受力情况。
[0045]S103:将比力信息进行坐标系变换。
[0046]将该比力信息进行角坐标变换，优选将其坐标系通过欧拉角坐标变换方法变换为表征实际地理位置的大地坐标系下的比力信息，为了便于区别，将变换后的比力信息作为大地坐标比力信息。
[0047]S104:根据预设的模糊规则表得到碰撞情况。
[0048]该模糊规则表为根据工程实践得到的一个二维的数表，其中包括多个预设姿态信息阈值和多个预设大地坐标比力信息阈值，还包括多个与上述两个参数对照的碰撞情况，该碰撞情况包括前向碰撞、后向碰撞、左向碰撞、右向碰撞和抬起空转。
[0049]在对该模糊规则表进行查表时，分别将姿态信息与多个预设姿态信息阈值进行一一对比，并同时将大地坐标比力信息与多个预设姿态信息阈值一一对比，当该姿态信息与某一预设姿态信息阈值相匹配，且同时该大地坐标比力信息与某一预设大地坐标比力信息阈值相匹配时，则判断此时发生同时与该某一预设姿态信息阈值和该某一预设大地坐标比力信息阈值相对应的碰撞情况。从而确定当前自主机器人是发生什么样的碰撞。
[0050]从上述技术方案可以看出，本实施例提供了一种自主机器人的碰撞检测方法，该方法将获取的加速度数据和角速度数据进行计算，通过数据融合得到自主机器人的姿态信息，通过坐标变换得到自主机器人的坐标比力信息，然后根据该姿态信息和坐标比力信息对预设的模糊规则表进行查表操作，从而得到该自主机器人的碰撞情况，进而够根据该碰撞情况采取相应措施，以保证自主机器人能够正常工作。
[0051]实施例二
[0052]在检测到自主机器人的碰撞情况后，如果还能够得到该碰撞情况发生的地点后，就能够根据其所处空间的具体情况采取相应避让措施，例如碰到墙壁后可以采取掉头或者后退，当碰到较小障碍物的时候可以选择直接越过或转向以避开，为此，本申请还提供了以下的实施例以确定碰撞地点。
[0053]图2为本申请另一实施例提供的一种自主机器人的碰撞检测方法的流程图。
[0054]本实施例提供的碰撞检测方法是在上一实施例的基础上做了部分改进，完成的流程图如图2所不。
[0055]S201:计算自主机器人的姿态信息。
[0056]在获取该自主机器人的加速度数据和角速度数据后，将两者进行数据融合，得到自主机器人的姿态信息。
[0057]加速度数据即在三个轴向上的加速度数据，角速度数据为三个轴向上的角速度数据，记为。然后通过卡尔曼滤波算法进行数据融合，从而得到该姿态信息。
[0058]S202:对加速度数据进行比力换算。
[0059]对加速度数据进行比力换算，即将上述的三个轴向上的加速度数据进行计算，得到三个轴向上的比力信息。比力等于加速度乘以重力加速度，用于表征在三个轴向上的受力情况。
[0060]S203:将比力信息进行坐标系变换。
[00