《位置检测装置、位置检测方法及位置检测程序.pdf》由会员分享,可在线阅读,更多相关《位置检测装置、位置检测方法及位置检测程序.pdf(29页珍藏版)》请在专利查询网上搜索。
1、(10)申请公布号 CN 103827632 A (43)申请公布日 2014.05.28 CN 103827632 A (21)申请号 201280002935.2 (22)申请日 2012.09.06 G01C 21/00(2006.01) (71)申请人 株式会社东芝 地址 日本东京都 申请人 东芝解决方案株式会社 (72)发明人 池谷直纪 (74)专利代理机构 永新专利商标代理有限公司 72002 代理人 王成坤 胡建新 (54) 发明名称 位置检测装置、 位置检测方法及位置检测程 序 (57) 摘要 位置检测装置具有位置估计部、 更新部、 位置 修正部。位置估计部根据移动体的绝对位置。
2、和根 据自律航法求出的移动体的位置变化, 估计移动 体的位置。更新部基于估计出的移动体的位置及 移动体的动作中的、 至少一个, 更新多个每个区域 的信息即表示移动体存在的频度越高则概率越高 的存在概率信息。位置修正部基于更新过的存在 概率信息, 对估计出的移动体的位置进行修正, 以 使移动体存在于概率高的位置。 (85)PCT国际申请进入国家阶段日 2013.03.18 (86)PCT国际申请的申请数据 PCT/JP2012/072756 2012.09.06 (87)PCT国际申请的公布数据 WO2014/038041 JA 2014.03.13 (51)Int.Cl. 权利要求书 2 页 。
3、说明书 13 页 附图 13 页 (19)中华人民共和国国家知识产权局 (12)发明专利申请 权利要求书2页 说明书13页 附图13页 (10)申请公布号 CN 103827632 A CN 103827632 A 1/2 页 2 1. 一种位置检测装置, 其特征在于, 具有 : 位置估计部, 根据移动体的绝对位置和根据自律航法求出的上述移动体的位置变化, 估计上述移动体的位置 ; 以及 位置修正部, 基于多个每个区域的信息、 即表示上述移动体存在的频度越高则概率越 高的存在概率信息, 对估计出的上述移动体的位置进行修正, 以使上述移动体存在于概率 高的位置。 2. 如权利要求 1 所述的位置。
4、检测装置, 其特征在于, 还具有 : 更新部, 基于估计出的上述移动体的位置及上述移动体的动作中的、 至少一个, 更新上 述存在概率信息, 上述位置修正部基于更新过的上述存在概率信息, 对估计出的上述移动体的位置进行 修正。 3. 如权利要求 2 所述的位置检测装置, 其特征在于, 上述更新部在执行基于估计出的上述移动体的位置来更新上述存在概率信息的处理 时, 使与估计出的上述移动体的位置对应的上述存在概率信息上升, 从而更新上述存在概 率信息。 4. 如权利要求 3 所述的位置检测装置, 其特征在于, 上述更新部根据在任意期间估计出的上述移动体的位置, 计算上述移动体通行了的路 径, 在计算。
5、出的路径中, 使与上述移动体存在的位置对应的上述存在概率信息上升, 从而更 新上述存在概率信息。 5. 如权利要求 2 所述的位置检测装置, 其特征在于, 上述更新部在执行基于上述移动体的动作来更新上述存在概率信息的处理时, 在由上 述移动体进行特定动作时, 使与进行预先登记的上述特定动作的位置对应的上述存在概率 信息上升, 从而更新上述存在概率信息。 6. 如权利要求 5 所述的位置检测装置, 其特征在于, 上述位置修正部根据预先登记的上述特定动作的种类, 使估计出的上述移动体的位置 的修正变化。 7. 如权利要求 4 所述的位置检测装置, 其特征在于, 上述位置修正部将上述移动体的上述绝对。
6、位置作为上述路径的起点, 对于起点以后的 在上述路径上的、 上述移动体存在的位置, 执行表示上述移动体的移动幅度的修正的伸缩 修正处理及表示上述移动体的行进方向的修正的旋转修正处理中的至少一种处理, 从而对 估计出的上述移动体的位置进行修正。 8. 一种位置检测方法, 其特征在于, 包含 : 根据移动体的绝对位置和根据自律航法求出的上述移动体的位置变化, 估计上述移动 体的位置的步骤 ; 以及 基于多个每个区域的信息、 即表示上述移动体存在的频度越高则概率越高的存在概率 信息, 对估计出的上述移动体的位置进行修正, 以使上述移动体存在于概率高的位置的步 骤。 9. 一种位置检测程序, 用于使计。
7、算机执行以下步骤 : 根据移动体的绝对位置和根据自律航法求出的上述移动体的位置变化, 估计上述移动 权 利 要 求 书 CN 103827632 A 2 2/2 页 3 体的位置的步骤 ; 以及 基于多个每个区域的信息、 即表示上述移动体存在的频度越高则概率越高的存在概率 信息, 对估计出的上述移动体的位置进行修正, 以使上述移动体存在于概率高的位置的步 骤。 权 利 要 求 书 CN 103827632 A 3 1/13 页 4 位置检测装置、 位置检测方法及位置检测程序 技术领域 0001 本发明的实施方式涉及位置检测装置、 位置检测方法及位置检测程序。 背景技术 0002 以往, 检测步。
8、行者等移动体的位置的技术中, 已知有利用了 GPS(Global Positioning System : 全球定位系统) 的技术、 利用了无线装置的技术、 利用了根据自律航 法 (dead reckoning) 求出的位置变化的技术等。这些技术中的利用无线装置的技术为如 下技术 : 根据配置于任意场所的无线装置与由步行者所保持的终端装置的通信状态, 检测 步行者的位置。 0003 另外, 虽然利用 GPS 或无线装置的技术能够检测绝对位置, 但是存在有测量误差 或在电波不到达的场所无法利用等问题, 因此有时无法持续并高精度地检测位置。 因此, 有 将绝对位置和根据自律航法求出的位置变化组合来。
9、估计更准确的位置的技术。另外, 在导 航装置中, 也存在采用了利用地图信息对估计出的位置进行修正的称为地图匹配的技术的 装置。 0004 现有技术文献 (专利文献) 0005 专利文献 1 : 日本特开 2011-17610 号公报 发明内容 0006 发明要解决的课题 0007 然而, 在现有技术中, 存在难以高精度地确定步行者的位置等问题。具体而言, 就 绝对位置而言, 有时如上所述那样地、 无法持续并高精度地检测。 另外, 就自律航法而言, 误 差伴随着时间经过而累计, 因此若仅用自律航法则难以持续并高精度地检测位置。 另外, 就 地图匹配而言, 为了准备表示步行者能够步行的场所的地图,。
10、 需要极大的劳动力。也就是 说, 考虑到表示步行者能够步行的场所的地图具有比车辆能够通行的场所更多的能够步行 的场所, 并且场所的变化频繁地发生, 因此其准备需要极大的劳动力。其结果是, 在现有技 术中, 无法低成本、 容易而且高精度地确定步行者的位置。 0008 本发明要解决的课题在于, 提供能够容易并且高精度地确定步行者的位置的位置 检测装置、 位置检测方法及位置检测程序。 0009 用于解决课题的手段 0010 实施方式的位置检测装置具有位置估计部和位置修正部。 位置估计部根据移动体 的绝对位置和根据自律航法求出的移动体的位置变化, 估计移动体的位置。位置修正部基 于多个每个区域的信息即。
11、表示移动体存在的频度越高则概率越高的存在概率信息, 对估计 出的移动体的位置进行修正, 以使移动体存在于概率高的位置。 附图说明 0011 图 1 是表示第 1 实施方式涉及的位置检测装置的框图。 说 明 书 CN 103827632 A 4 2/13 页 5 0012 图 2 是表示位置估计部的输出结果的图。 0013 图 3 是说明第 1 实施方式涉及的路径计算处理的图。 0014 图 4 是表示应当作为目标的存在概率信息的图。 0015 图 5 是表示第 1 实施方式涉及的存在概率信息的图。 0016 图 6 是说明第 1 实施方式涉及的位置修正处理的图。 0017 图 7 是表示第 1。
12、 实施方式涉及的整体处理的流程的流程图。 0018 图 8 是表示第 2 实施方式涉及的位置检测装置的框图。 0019 图 9 是表示第 2 实施方式涉及的存在概率信息的图。 0020 图 10 是说明第 2 实施方式涉及的位置修正处理的图。 0021 图 11 是表示第 2 实施方式涉及的整体处理的流程的流程图。 0022 图 12 是表示第 3 实施方式涉及的存在概率信息的图。 0023 图 13 是说明第 3 实施方式涉及的位置修正处理的图。 具体实施方式 0024 (第 1 实施方式) 0025 图 1 是表示第 1 实施方式涉及的位置检测装置的结构例的框图。如图 1 所示, 位 置检。
13、测装置100具有 : 位置估计部110、 更新部120、 存储部130以及位置修正部140。 另外, 位置检测装置 100 从绝对位置检测部 1 取得绝对位置, 并且从自律航法处理部 2 取得相对 位置。绝对位置检测部 1 和自律航法处理部 2, 例如包含于由作为移动体的步行者 (用户) 保持的终端装置。 0026 绝对位置检测部1进行利用了GPS的绝对位置的检测。 例如, 绝对位置检测部1每 隔 5 秒尝试检测, 将能够检测到的情况下的经度 “Xa” 和纬度 “ya” 输出至位置检测装置 100。 此外, 在绝对位置检测部 1 中, 也可以不仅利用利用了 GPS 的绝对位置的检测, 还利用各。
14、种 绝对位置的检测方法中的多个。 0027 作为其他的方法, 例如列举出通过利用照相机并识别人物由此检测相应的用户的 位置的方法、 根据无线装置与终端装置的通信状态来检测位置的方法等。在根据无线装 置与终端装置的通信状态来检测位置的方法中, 根据与 Wi-Fi(注册商标) 、 RFID(Radio Frequency Identification : 射频设别) 设备的通信状态, 利用预先登记的无线通信基站的 位置作为绝对位置的检测结果。 0028 在本实施方式中, 绝对位置虽然无需始终能够检测, 但能够维持一定的可靠性是 较为理想的。因为该情况, 可以为, 使用测量精度的指数即 DOP(Di。
15、lution Of Precision : 几何精度因子) 值, 并仅使用能够维持一定的可靠性的数据。另外, 当由于进入到建筑物内 或地下从而不能获得来自 GPS 的卫星信息时, 可以为, 利用预先保持的建筑物的入口或地 下的入口的坐标。 0029 自律航法处理部 2 用自律航法计算相对的位置变化。例如, 自律航法处理部 2 从 加速度传感器检测步行者的步数, 根据预先规定的传感器的安装方向、 地磁传感器的输出 以及加速度传感器的输出, 检测行进方向。并且, 自律航法处理部 2 执行累计处理, 由此计 算步行者的相对的位置变化, 其中, 该累计处理是 : 将利用预先登记的步行者的步幅并在检 测。
16、出的行进方向上移动了步幅距离的动作进行检测出的步数的处理。此外, 自律航法是计 说 明 书 CN 103827632 A 5 3/13 页 6 算相对的位置变化的方法, 因此为了计算绝对位置而从外部取得一次绝对位置。在本实施 方式中, 在后述的位置估计部 110 中利用绝对位置。 0030 在此, 对由自律航法处理部 2 执行的各处理的详细进行说明。检测步行者的步数 的处理根据加速度传感器的变化来检测步数。该步数不是总计的步数, 而是作为在步数的 增加时返回 “1” 而在其以外时返回 “0” 的时间的函数 “stepSignal(t) ” , 来检测步数。例 如, 设来自加速度传感器的传感器值。
17、被离散地取得, 在设时刻 “t t1, t2, t3, ” 的加 速度传感器的值为 “a(t) ” 时,“stepSignal(t) ” 以 (式 1) 及 (式 2) 表示。即,“stepSignal (t) ” 是在步行时的脚着地时为 “1” 的函数。此外, 阈值 “thwalk” 设为 1.0(G) 。 0031 式 1 0032 0033 式 2 0034 0035 另外, 检测步行者的行进方向的处理检测步行者的行进方向作为绝对方位。更具 体而言, 从地磁传感器检测终端装置的绝对方位, 从预先规定的传感器的安装方向获得步 行者的行进方向的角度, 并且从加速度传感器的输出获得重力矢量, 。
18、计算行进方向。例如, 设终端装置的 xyz 坐标系中的行进方向矢量为 “Vf (xf, yf, zf) ” , 设地磁传感器的北方 向矢量为 “Vn (xn, yn, zn) ” , 设从加速度传感器获得的重力方向矢量为 “Vg (xg, yg, zg) ” 。并且, 表示步行者的行进方向的绝对方位的角度 “direction” 利用矢量的内积 “” 和外积 “” 及余弦的反函数 “acos” , 通过 (式 3) (式 6) 来求出。 0036 式 3 0037 0038 式 4 0039 0040 式 5 0041 0042 式 6 0043 0044 在此, 时间 “t” 时的重力矢量 。
19、“Vg(t) ” 作为加速度矢量 “a(t) ” 的一定时间的平 均值, 能够通过 (式 7) 来计算。此外,“T” 设为 1 秒。 0045 式 7 0046 0047 其结果是, 步行者的行进方向基于随时从各种传感器输出的传感器值而随时计 说 明 书 CN 103827632 A 6 4/13 页 7 算, 由此作为相对于时间的行进方向的函数 “direction(t) ” 被检测, 该相对于时间的行进 方向的函数 “direction(t) ” 采用了将北设为 0 度并将东设为 90 度的角度。此外, 也可以 采用未将传感器的安装方向设为固定的方法, 但本实施方式中的详细的说明省略。 0。
20、048 另外, 就步行者的步幅而言, 如上所述那样地、 利用预先登记的固定值。 即, 在设该 固定值为 “0.7(m) ” 时, 为 “stepSize(t) 0.7” 。但是, 就步幅而言, 因人而异, 因此也可 以事先登记按每个用户而不同的步幅。另外, 步幅也可以为从预先登记的用户的身高减去 “1(m) ” 等指定值而得到的值 “用户的身高 -1” , 也可以从加速度传感器取得步行时的着地 的冲击的大小并根据所取得的冲击的大小来估计。 0049 自律航法处理部 2 的处理使用步数的检测结果即 “stepSignal(t)” 、 行进方向的 检测结果即 “direction(t)” 、 步幅。
21、即 “stepSize(t)” , 计算位置的变化。并且, 相对位置的 坐标 “xr(t)” 、“yr(t)” 通过更新式即 ( 式 8) 及 ( 式 9) 来计算。 0050 式 8 0051 xr(t+1)=xr(t)+stepSignal(t)*cos(direction(t)*stepSize(t) 0052 式 9 0053 yr(t+1)=yr(t)+stepSignal(t)*(-sin(direction(t)*stepSize(t) 0054 位置估计部110根据由绝对位置检测部1检测到的步行者的绝对位置和由自律航 法处理部2根据自律航法求出的步行者的位置变化, 估计步行者的。
22、当前的位置(x, v)。 在位 置估计部 110 进行的位置估计中, 存储刚刚检测出的绝对位置 (xa, ya) 和检测时的时刻 ta。 并且, 在位置估计部 110 进行的位置估计中, 刚刚检测出的自律航法的相对位置 (xr, yr) 也 一并存储。也就是说, 在某时刻 t 检测出绝对位置时, 位置估计部 110 采用该绝对位置作为 可靠性高的值。并且, 在未检测到绝对位置时, 位置估计部 110 根据最后能够检测出的绝对 位置的场所来计算自律航法的差分, 从而计算时刻 t 的位置。这种位置估计部 110 进行的 位置估计能够通过 ( 式 10) 及 ( 式 11) 来表示。 0055 式 。
23、10 0056 x(t)=xa+xr(t)-xr(ta) 0057 式 11 0058 y(t)=ya+yr(t)-yr(ta) 0059 作为位置估计部 110 的位置估计的输出, 为位置 (x(t), v(t), 但在本实施方式 中, 在后段的处理中利用的 xa(t)、 ya(t)、 xr(t)、 yr(t) 也作为输出的对象。图 2 是表示位 置估计部 110 的输出结果的例子的图。如图 2 所示, 位置估计部 110 在各时刻 t 输出能够 检测到的绝对位置的经度及纬度、 相对位置的经度及纬度、 估计出的位置的经度及纬度。 若 举例, 则位置估计部 110 在时刻 “2011/9/91。
24、3 : 10 : 00” , 输出绝对位置的经度 “139.696844” 及纬度 “35.532155” 、 相对位置的经度 “139.696844” 及纬度 “35.532155” 、 估计出的位置的 经度 “139.696844” 及纬度 “35.532155” 。 0060 在图 2 所示的例子中, 从时刻 “2011/9/913 : 10 : 15” 起到时刻 “2011/9/913 : 10 : 45” 为止未能检测到绝对位置, 此时估计的位置基于在时刻 “2011/9/913 : 10 : 10” 能够检测 出的绝对位置来计算。但是, 实际上绝对位置的检测也存在因多路径等的影响而。
25、产生误差 的情况。为此, 在用上述的 DOP 值等测量精度的指数并保证一定以上的可靠性时, 可以作为 绝对位置 (xa, ya) 来采用。 说 明 书 CN 103827632 A 7 5/13 页 8 0061 更新部 120 基于由位置估计部 110 估计出的步行者的位置, 更新在存储部 130 中 所存储的存在概率信息。该存在概率信息是多个每个区域的信息, 是表示步行者存在的频 度越高则越高的概率的信息。 详细而言, 存在概率信息将位置作为坐标来表示, 并表示步行 者能够在某坐标通行的概率的高低。在这种存在概率信息中, 表现对坐标 (x, y) 的通行可 能性进行表示的函数 p(x, y。
26、) 。 0062 本实施方式涉及的存在概率信息为 : 将位置细分化为一定大小的格子, 并以 0 到 1 的概率来表现与各个位置有关的通行可能性, 但关于通行可能性的表现, 并不限于此。例 如, 通行可能性的表现也可以采用重合了多个高斯分布的混合高斯分布等。 0063 更具体而言, 更新部 120 的处理将由位置估计部 110 输出的信息和从存储部 130 取得的存在概率信息作为输入, 执行检测位置存储处理、 路径计算处理、 更新处理。 以下, 对 这些处理进行说明。 0064 检测位置存储处理为 : 为了在路径计算处理中利用的、 位置的时间变化的轨迹即 路径的构建, 而将由位置估计部 110 。
27、估计出的位置缓存的处理。例如, 估计出的位置的缓存 将最近的 60 分钟的位置信息与检测时的时间信息一起存储。此外, 缓存所需的时间是路径 的构建所用的时间, 因此不限于 60 分钟, 能够适当变更。 0065 路径计算处理为 : 在作为具有一定可靠性的位置的起点和终点之间, 套用自律航 法的位置计算结果的履历来计算路径的处理。 如上所述那样地、 绝对位置在能够检测到时, 作为具有一定可靠性的位置而采用。 在利用自律航法的位置计算中, 误差可能会累计, 误差 的大部分起因于行进方向的检测误差和步幅检测误差。但是, 行进方向检测误差和步幅检 测误差的、 作为时间性的变化较少的情况较多。 另外, 。
28、就步数的检测而言, 认为误差比较少。 也就是说, 误差的大部分作为 “旋转” 、“伸缩” 被发现的情况较多, 其中,“旋转” 作为行进方 向检测误差,“伸缩” 作为步幅检测误差。 0066 因此, 假定设作为具有一定可靠性的位置的起点为时刻 “ts” 、 设终点为时刻 “te” , 并设这两个点是准确的位置, 来计算这两个点间的路径。更具体而言, 通过自律航法的 “旋 转” 和 “伸缩” 对起点及终点进行修正之后计算路径。 例如, 起点及终点的修正后的路径上的 位置 “x (t) ” 、“y (t) ” 用伸缩修正值 “dl” 和旋转修正值 “d” , 通过 (式 12) (式 18) 来计算。
29、。在 (式 12) (式 18) 中, 设坐标 (xas, yas) 为起点, 修正为使从时刻 ts起到 t 为止 的自律航法的位置变化的轨迹旋转 d 并伸缩 dl 后的坐标。 0067 式 12 0068 0069 式 13 0070 0071 式 14 0072 0073 式 15 0074 说 明 书 CN 103827632 A 8 6/13 页 9 0075 式 16 0076 0077 式 17 0078 x (t)=xas+dl(xre(t)-xrs)cosd-(yre(t)-yrs)sind) 0079 式 18 0080 y (t)=yas+dl(xre(t)-xrs)sin。
30、d-(yre(t)-yrs)cosd) 0081 图 3 是说明第 1 实施方式涉及的路径计算处理的图。在图 3 所示的例中, 圆形标 记表示实际的位置。 圆形标记中的、 白色圆形标记是不能检测到的位置, 阴影圆形标记是能 够部分检测到的位置 ( 绝对位置 )。另外, 阴影圆形标记中的、 右方的圆形标记是时刻 ts的 起点。另一方面, 在图 3 所示的例中, 叉形标记是自律航法的位置变化。叉形标记中的、 时 刻 t 0 的叉形标记与起点一致。即, 在起点, 绝对位置和相对位置重合。并且, 时刻 t 0 以后, 伴随着时间, 绝对位置和相对位置之间的误差产生差异 ( 開 )。在图 3 所示的例 。
31、中, 发生了有规律的行进方向的检测误差即角度的误差。为此, 在检测到终点 (xae, yae) 的 时刻 te, 执行存在概率信息的更新处理, 通过 j 将起点固定的旋转的修正, 获得图 3 所示的 圆形标记的轨迹作为更准确的路径。 0082 更新处理是使用由路径计算处理计算出的路径信息更新在存储部 130 中所存储 的存在概率信息的处理。存在概率信息如上所述那样地、 是表示步行者存在的频度越高则 越高的概率的信息, 将位置表示为坐标, 表示步行者能够在某坐标通行的概率的高低。 这种 存在概率信息虽然与地图相似但在一般的地图中有时并不示出步行者能够通行的场所, 因 此与单纯的地图不同。 但是,。
32、 存在概率信息也可以基于地图的信息, 以将不能通行的场所的 存在概率设为较低的值并将能够通行的场所的存在概率设为比较高的值的方式来生成。 0083 就存在概率信息而言, 位置的格子通过纬度和经度来识别。存在概率信息的格子 尺寸作为一个形态设为 1 米见方。即, 存在概率信息为 : 对于通过纬度和经度来识别的 1 米 单位的格子, 分别示出以 0 到 1 的概率值赋予的一个存在概率的数据结构。图 4 是表示应 当作为目标的存在概率信息的例子的图。如图 4 所示, 应当作为目标的存在概率信息按格 子坐标的顺序排列存在概率, 作为概率值, 将能够通行的场所设为 “1” , 将不能通行的场所 设为 “。
33、0” 。此外, 存在概率信息除了纬度和经度以外, 也可以使用建筑物内中的楼层信息通 过三维格子来对待。另外, 在本实施方式中, 存在概率信息的概率值最初没有时, 对于全部 概率值, 设定为 “0.2” 等值即可。 0084 在此, 若路径信息没有误差, 则存在概率信息的更新是将路径上的格子的概率值 更新为 “1” 的处理, 但由于实际上路径信息存在误差, 因此为了获得更准确的存在概率信 息, 利用重复检测的路径信息来更新。在本实施方式中, 利用 (式 19) 及 (式 20) 执行更新处 理。 0085 式 19 0086 0087 式 20 说 明 书 CN 103827632 A 9 7/。
34、13 页 10 0088 0089 在 (式 19) 中,“” 是更新率, 例如设为取 “0.3” 等值。该更新率表示将利用的路 径信息反映到存在概率信息中的比例, 如果利用的路径信息正确, 则提高该更新率的是较 为理想的。另外, Nx、 Ny是格子的 x 方向、 y 方向的最大值, 设 “NxNy” 表示总格子。另外, Pmax 是所规定的平均概率的最大值, 例如取 “0.5” 等值。 0090 通过这些处理, 存在概率信息中, 路径上的场所其概率接近 “1” , 通过重复进行更 新处理该概率逐渐接近 “1” 。 图5是表示第1实施方式涉及的在存储部130中所存储的存在 概率信息的例子的图。。
35、 如图5所示, 存在概率信息为通过上述的处理在各格子中表示 “0.0” 至 “1.0” 的概率值。另外, 在单纯地使步行者存在的频度高的能够通行的场所的概率接近 “1” 的处理中, 在包含误差的情况下, 全部格子的概率接近 “1” 。为此, 在本实施方式中, 执 行更新处理, 以使全部格子的平均概率不超过一定值。 其结果是, 在更新处理中, 作为原则, 存在的频度高的场所的存在概率接近 “1” , 但存在的频度低的场所的存在概率即使实际上 能够通行也可能为接近 “0” 的值 (或 “0” ) 。 0091 位置修正部 140 基于由存储部 130 存储的存在概率信息, 通过位置估计部 110 。
36、对 估计出的位置进行修正, 以使步行者存在于概率高的位置。在位置修正部 140 的位置修正 处理中, 不仅修正瞬间的位置偏差, 还对于步行者通行的路径整体进行修正, 以使似然变 高。 在此, 认为 : 当在存在概率低的场所通行时, 设为估计出的位置有误差, 并向估计出的位 置附近的存在概率高的位置进行修正的方法是一般的。但在本实施方式中, 以使与步行者 通行过的路径整体有关的存在概率信息的累计的似然最大化的方式进行修正。例如, 活用 上述的路径计算处理, 如 (式 21) 那样获得修正用的参数。 0092 式 21 0093 0094 也就是说, 获得使修正后的路径所包含的格子的概率值的总和最。
37、大化的这种旋 转修正值 “” 、 伸缩修正值 “l” 。实际上, 使 及 l 在一定的范围内例如设为 “-30 30” 、“0.8 l 1.2” 来离散地变化, 并对于各自分别计算概率值的总和, 获得达到最大 的 及 l。在此, 若似然同等, 则可以说旋转修正值 接近 “0” 并且伸缩修正值 l 接近 “1” 的一方由于修正量变少因此是更优的结果。作为用于不过于使修正量变大的制约, 使从似 然项减去正则化项 “c1+c2l” 后的值最大化也是有效的。使用旋转修正值 “” 和伸缩修 正值 “l” , 表示实际的路径及位置的、 估计位置的修正后的坐标 (x (t), v (t) 通过 ( 式 22。
38、) 及 ( 式 23) 来表示。 0095 式 22 0096 x (t)=xas+1(xre(t)-xrs)cos-(yre(t)-yrs)sin) 0097 式 23 0098 y (t)=yas+1(xre(t)-xrs)sin+(yre(t)-yrs)cos) 0099 这样, 通过对估计出的位置进行修正, 尤其能够对成为步行者的自律航法中的大 的误差要因的作为行进方向检测误差的 “旋转” 和作为步幅检测误差的 “伸缩” 进行修正, 并获得更准确的位置。 说 明 书 CN 103827632 A 10 8/13 页 11 0100 图 6 是说明第 1 实施方式涉及的位置修正处理的图。。
39、在图 6 所示的例中, 在成为 起点的阴影圆形标记以后, 不能获得准确的绝对位置, 作为自律航法的相对位置, 检测出如 叉形标记那样的估计位置(参照图6左方)。 若为该叉形标记的轨迹, 则成为步行者在存在 概率低的场所通行。 对于这种轨迹, 如上所述那样地、 利用存在概率信息以似然达到最大的 方式进行修正时, 获得如圆形标记那样的修正结果 ( 参照图 6 右方 )。 0101 接着, 用图 7 说明第 1 实施方式涉及的整体处理的流程。图 7 是表示第 1 实施方 式涉及的整体处理的流程的例子的流程图。 0102 如图 7 所示, 位置估计部 110 取得由绝对位置检测部 1 检测到的步行者的。
40、绝对位 置和由自律航法处理部 2 求出的自律航法的步行者的位置变化即相对位置 ( 步骤 S101)。 然后, 位置估计部 110 根据绝对位置和相对位置, 估计步行者的当前的位置 ( 步骤 S102)。 0103 另外, 更新部 120 对由位置估计部 110 估计出的步行者的位置进行缓存 ( 步骤 S103)。然后, 更新部 120 在判断为已经过了 60 分钟等任意期间时 ( 步骤 S104 : 是 ), 基 于进行了缓存的位置, 计算使用伸缩修正值和旋转修正值进行了修正的位置的路径 ( 步骤 S105)。另一方面, 在通过更新部 120 判断为未经过任意期间时 ( 步骤 S104 : 否。
41、 ), 再次执行 步骤 S101 的处理, 并进行路径的计算所需的位置的估计及缓存。 0104 接下来, 更新部 120 使用计算出的路径, 更新在存储部 130 中所存储的存在概率 信息 (步骤 S106) 。另外, 位置修正部 140 基于在存储部 130 中所存储的存在概率信息, 对 于包含由位置估计部 110 估计出的位置的路径进行修正, 以使步行者存在于概率高的位置 (步骤 S107) 。此外, 关于估计出的位置的修正, 在存在概率信息被更新后进行不是必要的, 也可以在位置估计部 110 的位置估计后进行。也就是说, 存在概率信息的更新处理在获得 了具有一定可靠性的起点及终点的时刻被。
42、更新是较为理想的, 估计出的位置的修正处理能 够在位置被估计出的时刻随时进行。 0105 如上所述, 通过更新存在概率信息并且进行基于存在概率信息的估计位置的修 正, 能够进行基于自律航法的相对位置的高精度的位置输出。 换言之, 即使屋内仅有数处也 能够检测高精度的位置 (绝对位置) , 或者能够高精度地仅检测建筑物的出入口的位置 (绝 对位置) , 由此能够生成依存于与布局图等不同的实际的通行概率的地图。另外, 通过逐次 更新存在概率信息, 与将能够通行的位置设为 “1” 并将不能通行的位置设为 “0” 的地图相 比, 在检测实际的步行者的位置时进行更准确的修正的情况较多。 此外, 并不特别。
43、地限于在 屋内的应用, 在屋外在绝对位置的检测中存在误差时, 也可以并用自律航法的详细的位置 检测。其结果是, 在本实施方式中, 能够容易并且高精度地确定步行者的位置。 0106 (第 1 实施方式涉及的位置修正处理的变形例) 0107 在上述第 1 实施方式中, 对使用旋转修正值和伸缩修正值求出步行者通行了的路 径的情况进行了说明, 但也可以进一步使用角速度修正值。 更具体而言, 将使用了陀螺仪等 角速度传感器的姿势检测活用在自律航法中。在此情况下, 通过角速度的积分求出角度的 变化, 但由于陀螺仪的误差, 自律航法的轨迹中引入了角速度的误差, 从而有可能变为明明 实际上是直线运动, 却成了。
44、始终旋转的圆运动。 0108 对于这种问题, 通过 (式 24) 计算使似然最大化的角速度修正值, 使用计算出 的角速度修正值来再次计算路径, 由此能够与第 1 实施方式同样地对估计出的位置进 说 明 书 CN 103827632 A 11 9/13 页 12 行修正。 0109 式 24 0110 0111 (第 2 实施方式) 0112 图 8 是表示第 2 实施方式涉及的位置检测装置的结构例的框图。在第 2 实施方式 中, 对于与第 1 实施方式同样的构成标注同一符号, 对于同样的构成有时省略详细的说明。 在第 2 实施方式中, 关于以下所示的动作检测部 3、 更新部 220、 存储部 。
45、230 以外的功能及构 成、 处理与第 1 实施方式相同。 0113 如图 8 所示, 位置检测装置 200 具有 : 位置估计部 110、 更新部 220、 存储部 230 及 位置修正部 140。另外, 位置检测装置 200 从绝对位置检测部 1 取得绝对位置, 并且从自律 航法处理部 2 取得相对位置。另外, 位置检测装置 200 从动作检测部 3 取得步行者 (用户) 的动作。该动作例如为电梯移动、 付款、 在交叉点或站台等处的静止、 卸货等。本实施方式 中, 关于步行者的动作, 进行的场所根据动作而受限, 所以将特定动作被检测到时的位置修 正为进行该特定动作的可能性高的位置, 由此对。
46、估计出的位置进行修正。 0114 动作检测部 3 检测步行者的动作。例如, 关于付款动作, 在电子货币的付款事件被 终端装置检测到时, 对位置检测装置 200 输出进行了付款动作。当在时间 t 发生付款动作 时, 设动作检测函数 “actpay(t) 1” , 对于其他情况, 设 “actpay(t) 0” 。 0115 另外, 例如, 关于静止状态的检测, 利用搭载于终端装置的加速度传感器的值。更 具体而言, 在静止状态的检测中, 对于三维矢量的加速度传感器值 “a(t) ” , 总是计算矢量 长, 经过 10 秒钟等一定时间来计算矢量长的方差值 “v(t) ” , 在为 “0.001” 等。
47、阈值以下时, 看作静止状态。该方差值 “v(t) ” 由 (式 25) 表示。 0116 式 25 0117 0118 另外, 例如, 关于电梯移动, 电梯中准备 Blue Tooth( 注册商标 ) 等近距离无线基 站, 在终端装置能够进行无线通信时, 设为是正在进行处于电梯中的移动。此外, 电梯移动 也可以与静止状态同样地根据加速度传感器来估计。 另外, 除此之外, 电梯移动也可以将在 通过电梯的照相机检测到对象者的脸时设为是正在进行处于电梯中的移动。另外, 关于在 交叉点、 站台处的静止、 卸货动作, 也于电梯同样地, 通过无线通信或照相机来检测。即, 动 作检测部 3 与绝对位置检测部。
48、 1 或自律航法处理部 2 等同样地, 有时也包含于终端装置, 有 时是上述照相机 ( 网络照相机 )。并且, 动作检测部 3 也存在不是单个而是多个的情况。另 外, 认为 : 动作检测部 3 的动作的检测并不限于上述, 关于其检测, 有利用了各种传感器的 方法。 0119 在存储部230中存储的存在概率信息为与第1实施方式涉及的存在概率信息同样 的数据结构。另外, 第 2 实施方式涉及的存在概率信息中, 对于各个特定动作保持其可能性 “Paction(x, y)” 。另外, 第 2 实施方式涉及的存在概率信息有预先准备的情况和由更新部 220 说 明 书 CN 103827632 A 12 10/13 页 13 更新的情况。 预先准备的情况例如是对于有可能进行付款、 电梯移动、 卸货等的场所事先登 记的情况。电梯存在于坐标 (3, 5) 时, 设为 “Pelevator(3, 5) 10” 。 0120 关于更新部 220 的更新处理, 以进行路径计算并对于在发生了由动作检测部 3 检 测到的特定动作时存在的位置来提高对象的动作的概率的方式进行更新。在本实施方式 中, 利用 ( 式 26) 及。