一种空间轨迹记录装置的制造方法
【专利摘要】本实用新型公开了一种空间轨迹记录装置，该装置固定在运动机构上，以记录运动机构运动的空间轨迹，其包括姿态信息采集模块，计程装置和处理模块；其中，姿态信息采集模块采集运动机构运动过程中的姿态信息，计程装置记录运动机构运动过程中的行程信息，处理模块按照设定频率，同步获取行程信息与姿态信息，并根据行程信息与姿态信息，实时地计算出位置信息，而且当运动机构每经过一个设定的单位行程时，处理模块存储当前时刻的位置信息；运动机构的运动停止后，根据运动机构开始运动前记录的静止时的位置信息和处理模块存储的位置信息，而获得运动机构运动的空间轨迹。本实用新型不受外界环境的干扰，而影响轨迹信息的精度。
【专利说明】
一种空间轨迹记录装置
技术领域
[0001] 本实用新型涉及运动轨迹记录技术领域，特别涉及一种空间轨迹记录装置。
【背景技术】
[0002] 目前，通过GPS等定位方式记录轨迹信息时，轨迹信息的精度易受信号强度影响， 而且在郊外、地下等环境几乎无法实现位置信息的准确定位。在信号不稳定的情况下，造成 定位准确度的主要因素有：（1)信号穿过不确定介质造成的衰减无法确定。（2)信号通过介 质的深度越深误差越大。（3)电磁信号的干扰。 【实用新型内容】
[0003] 本实用新型的目的在于克服在轨迹信息记录过程中，轨迹信息的精度易受信号强 度的影响。
[0004] 为了实现上述实用新型目的，本实用新型提供一种空间轨迹记录装置，用于固定 在运动机构上，记录运动机构运动的空间轨迹，其包括姿态信息采集模块，计程装置和处理 模块，所述姿态信息采集模块和所述计程装置分别与所述处理模块连接;其中，
[0005] 所述姿态信息采集模块，用于采集所述运动机构运动过程中的姿态信息；
[0006] 所述计程装置，用于记录所述运动机构运动过程中的行程信息；
[0007] 所述处理模块按照设定频率，同步获取所述行程信息与所述姿态信息，并根据所 述行程信息与所述姿态信息，实时地计算出位置信息，而且当运动机构每经过一个设定的 单位行程时，所述处理模块存储当前时刻的所述位置信息；
[0008] 运动机构的运动停止后，根据运动机构开始运动前所记录的静止时的位置信息和 所述处理模块存储的所述位置信息，而获得运动机构运动的空间轨迹。
[0009] 根据一种具体的实施方式，所述处理模块包括数字滤波器、处理器和存储器；其 中，
[0010] 所述数字滤波器，用于对所述姿态信息进行滤波处理；
[0011] 所述处理器，用于对所述姿态信息进行融合计算，以获得横滚角、俯仰角和航向 角，并根据所述横滚角、所述俯仰角和所述航向角，对所述行程信息进行空间坐标计算，得 到所述空间位移矢量信息，以及在每得到一个所述空间位移矢量信息后，根据所述空间位 移矢量信息和上次计算出的所述位置信息，计算得到本次的所述位置信息；
[0012] 所述存储器，用于存储所述处理器的所述位置信息。
[0013] 根据一种具体的实施方式，所述姿态信息采集模块包括三轴加速度计，三轴陀螺 仪和三轴电子罗盘，并且所述姿态信息包括三轴加速度信息、三轴角速度信息和所述三轴 磁场信息，其中，
[0014] 所述三轴加速度计，用于采集所述三轴加速度信息；
[0015] 所述三轴陀螺仪，用于采集所述三轴角速度信息；
[0016] 所述三轴电子罗盘，用于采集所述三轴磁场信息。
[0017] 根据一种具体的实施方式，所述计程装置包括编码器和传动装置，并且所述编码 器通过所述传动装置与所述运动机构连接，以将所述运动机构的行程转换为所述行程信 息。
[0018] 根据一种具体的实施方式，所述处理器设置有数据接口，用于扩展SD卡或者U盘。
[0019] 与现有技术相比，本实用新型的有益效果：
[0020] 本实用新型的装置可直接固定在运动机构上，在使用时，首先确定初始静止时的 位置信息，当运动机构运动时，本实用新型的装置按照设定频率，同步获取姿态信息和行程 信息，并经过一系列的运算和处理，获得当前位置信息，并将每次得到的位置信息保存在存 储介质中。本实用新型的装置由于没有采用GPS定位方式，所以不受外界环境的干扰，而影 响轨迹信息的精度。
【附图说明】
[0021 ]图1是本实用新型装置的结构示意图；
[0022]图2是本实用新型装置的各部件的连接示意图；
[0023]图3是本实用新型计算空间位移矢量原理示意图；
[0024]图4是本实用新型获得当前位置信息原理示意图。
【具体实施方式】
[0025] 下面结合【具体实施方式】对本实用新型作进一步的详细描述。但不应将此理解为本 实用新型上述主题的范围仅限于以下的实施例，凡基于本【实用新型内容】所实现的技术均属 于本实用新型的范围。
[0026] 结合图1所示的本实用新型的结构示意图，其中，本实用新型的空间轨迹记录装 置，用于固定在运动机构上，记录运动机构运动的空间轨迹，其包括姿态信息采集模块，计 程装置和处理模块，姿态信息采集模块和计程装置分别与处理模块连接。
[0027] 姿态信息采集模块在运动机构运动的过程中，记录运动机构的姿态信息。计程装 置在运动机构运动的过程中，记录运动机构的行程信息。
[0028] 处理模块按照设定频率，同步获取行程信息与姿态信息，并根据行程信息与姿态 信息，实时地计算出位置信息，而且当运动机构每经过一个设定的单位行程时，处理模块存 储当前时刻的位置信息。
[0029 ]运动机构的运动停止后，根据运动机构开始运动前所记录的静止时的位置信息和 处理模块存储的位置信息，而获得运动机构运动的空间轨迹。
[0030] 结合图2所示的本实用新型装置的各部件连接示意图；其中，本实用新型中的处理 模块包括数字滤波器、处理器和存储器。
[0031] 数字滤波器，用于对所述姿态信息进行滤波处理。
[0032] 处理器，用于对姿态信息进行融合计算，以获得横滚角、俯仰角和航向角，并根据 横滚角、俯仰角和航向角，对行程信息进行空间坐标计算，得到空间位移矢量信息，以及在 每得到一个空间位移矢量信息后，根据空间位移矢量信息和上次计算出的位置信息，计算 得到本次的位置信息。
[0033]存储器，用于存储处理器的位置信息。
[0034]本实用新型中的姿态信息采集模块包括三轴加速度计，三轴陀螺仪和三轴电子罗 盘，并且姿态信息包括三轴加速度信息、三轴角速度信息和三轴磁场信息。
[0035]三轴加速度计用于采集三轴加速度信息。三轴陀螺仪，用于采集三轴角速度信息。 三轴电子罗盘，用于米集三轴磁场信息。
[0036] 本实用新型中的计程装置包括编码器和传动装置，并且编码器通过传动装置与运 动机构，以将运动机构的行程转换为行程信息。
[0037]在实施时，处理器设置有数据接口，该数据接口用于扩展SD卡或者U盘，使数据存 储更加灵活，且方便转移至其他设备上。
[0038] 在本实用新型中，对空间轨迹记录的方法包括：
[0039] S1:确定运动机构初始静止时的位置信息，并保存至存储介质中。
[0040] S2:按照设定频率，同步获取运动机构运动过程中的姿态信息与行程信息，并根据 每次获取的姿态信息与行程信息，实时地计算出位置信息。
[0041] S3:当运动机构每经过一个设定的单位行程时，处理模块存储当前时刻的位置信 息。
[0042] S4:判断运动机构是否静止，若未静止，则跳转至S2。
[0043]结合图3所示的本实用新型计算空间位移矢量原理示意图；其中，在S2中，根据每 次获取的姿态信息与行程信息，得到空间位移矢量信息的方法为，
[0044] 对姿态信息进行融合计算，以获得横滚角、俯仰角和航向角，并根据横滚角、俯仰 角和航向角，对行程信息进行空间坐标计算，得到空间位移矢量信息，以及在每得到一个空 间位移矢量信息后，根据空间位移矢量信息和上次计算出的位置信息，计算得到本次的位 置信息。
[0045] 在实施时，对姿态信息进行滤波处理后，再进行融合计算。而且，计算得到位置信 息后，将计算得到的位置信息覆盖上次计算出的位置信息，从而降低处理模块的缓存负载， 提高计算速率。
[0046] 在具体实施时，由于本实用新型是按照设定频率，来同步获取姿态信息和行程信 息，所以前后两次同步获取姿态信息和行程信息之间有一定的时间间隔，而当这个时间间 隔足够短时，可将每个时间间隔内的运动状态认为直线运动。
[0047] 那么设时间间隔内的行程为St，俯仰角、横滚角和航向角分别为!和(i>t;在t至 t+1个时间间隔内,空间位移矢量表示为(i t，j t，kt)，则有：
[0049] 在已知t个时间间隔时的空间位置坐标为(Xt，yt，zt)，在t至t+1个时间间隔内，空 间位移矢量表示为(it，jt，kt)。
[0050]在实施时，将当前得到的空间位移矢量信息与上次计算出的位置信息相叠加，以 计算得到当前位置信息。因此，在t+1个时间间隔时的空间位置坐标表示为：
[0051 ] (xt+i,yt+i,zt+i) 一（xt，yt，zt) + (it，jt,kt) 〇
[0052]结合图4所示的本实用新型获得当前位置信息原理示意图；其中，已知初始静止时 的空间位置坐标(XQ，yQ，Z())的情况下，在t+1个时间间隔时的空间位置坐标表示为：
[0054] 本实用新型的装置可直接固定在运动机构上，在使用时，首先确定初始静止时的 位置信息，当运动机构运动时，本实用新型的装置按照设定频率，同步获取姿态信息和行程 信息，并经过一系列的运算和处理，获得当前位置信息，并将每次得到的位置信息保存在存 储介质中。本实用新型的装置由于没有采用GPS定位方式，所以不受外界环境的干扰，而影 响轨迹信息的精度。
[0055] 上面结合附图对本实用新型的【具体实施方式】进行了详细说明，但本实用新型并不 限制于上述实施方式，在不脱离本申请的权利要求的精神和范围情况下，本领域的技术人 员可以作出各种修改或改型。
【主权项】
1. 一种空间轨迹记录装置，用于固定在运动机构上，记录运动机构运动的空间轨迹，其 特征在于，包括姿态信息采集模块，计程装置和处理模块，所述姿态信息采集模块和所述计 程装置分别与所述处理模块连接;其中， 所述姿态信息采集模块，用于采集所述运动机构运动过程中的姿态信息； 所述计程装置，用于记录所述运动机构运动过程中的行程信息； 所述处理模块按照设定频率，同步获取所述行程信息与所述姿态信息，并根据所述行 程信息与所述姿态信息，实时地计算出位置信息，而且当运动机构每经过一个设定的单位 行程时，所述处理模块存储当前时刻的所述位置信息； 运动机构的运动停止后，根据运动机构开始运动前记录的静止时的位置信息和所述处 理模块存储的所述位置信息，而获得运动机构运动的空间轨迹。2. 如权利要求1所述的一种空间轨迹记录装置，其特征在于，所述处理模块包括数字滤 波器、处理器和存储器;其中， 所述数字滤波器，用于对所述姿态信息进行滤波处理； 所述处理器，用于对所述姿态信息进行融合计算，以获得横滚角、俯仰角和航向角，并 根据所述横滚角、所述俯仰角和所述航向角，对所述行程信息进行空间坐标计算，得到所述 空间位移矢量信息，以及在每得到一个所述空间位移矢量信息后，根据所述空间位移矢量 信息和上次计算出的所述位置信息，计算得到本次的所述位置信息； 所述存储器，用于存储所述处理器的所述位置信息。3. 如权利要求1所述的一种空间轨迹记录装置，其特征在于，所述姿态信息采集模块包 括三轴加速度计，三轴陀螺仪和三轴电子罗盘，并且所述姿态信息包括三轴加速度信息、三 轴角速度信息和三轴磁场信息，其中， 所述三轴加速度计，用于采集所述三轴加速度信息； 所述三轴陀螺仪，用于采集所述三轴角速度信息； 所述三轴电子罗盘，用于采集所述三轴磁场信息。4. 如权利要求1所述的一种空间轨迹记录装置，其特征在于，所述计程装置包括编码 器和传动装置，并且所述编码器通过所述传动装置与所述运动机构连接，以将所述运动机 构的行程转换为所述行程信息。5. 如权利要求2所述的一种空间轨迹记录装置，其特征在于，所述处理器设置有数据接 口，用于扩展SD卡或者U盘。
【文档编号】G01C23/00GK205506069SQ201620171256
【公开日】2016年8月24日
【申请日】2016年3月7日
【发明人】肖蕾, 庄鑫财, 刘克江, 罗国娟
【申请人】广东技术师范学院