专利名称：物体位置推定系统、物体位置推定装置、物体位置推定方法及物体位置推定程序的制作方法
技术领域：
本发明涉及根据观测机构所观测到的数据例如按照观测时刻的早晚顺序来推定在环境内存在的物体的位置的物体位置推定系统、物体位置推定装置、物体位置推定方法 及物体位置推定程序。
背景技术：
为了利用相机等传感器识别存在于环境内的对象物体，从而推定对象物体的ID 及在环境内的位置，大致分为5个必要的工序。在第一工序中，通过相机摄像对象物体，得到包括对象物体的图像数据。在第二工序中，比较预先保持的背景图像的模板和包括对象物体的图像数据，得 到差量图像。在第三工序中，使用使预先保持的图像数据中的像素位置与环境内位置对应的数 据库，获得得到的差量图像的环境内的物体位置备选。在第四工序中，使用使预先保持的物体的ID与图像数据对应的数据库，获得与得 到的差量图像对应的物体的ID备选。以下，将第三工序(得到物体位置备选的工序)和第 四工序(得到物体的ID备选的工序)合称为“物体识别”。在第五工序中，由于在个别的物体的ID备选及位置备选的数据中存在不可靠性， 因此使用过去通过相机得到的物体的ID和位置的数据，推定合理的各物体的位置。以下， 将第五工序称为“位置推定”。需要进行物体识别处理，在物体识别处理中，从传感器观测环境所得到的数据变 换为物体位置推定处理能够处理的与物体的ID备选和位置备选相关的数据。位置推定所必要的时间(第五工序)比传感器观测环境到物体识别结束所必要的 时间(第一工序至第四工序)长。由此，在对于存在于环境内的全部对象物体将物体识别后 的数据个别地进行位置推定的情况下，产生传感器观测到环境的时刻与物体识别处理结束 的时刻的延迟时间(响应等待时间)。图13中示出示例。观测装置1的观测数据1被物体 识别处理，能够进行物体位置推定处理的时刻为时刻14:17 20 (14时17分20秒)。观测装 置2的观测数据2被物体识别处理，能够进行物体位置推定处理的时刻为时刻14:17:26。然 而，在时刻14:17:26这一时间点，观测数据1的物体位置推定处理尚未结束，能够开始观测 数据2的物体位置推定处理的时刻从观测数据1的物体位置推定处理结束的时刻14:17:30 起。由此，观测数据2的物体位置推定处理必须等待观测数据1的物体位置推定处理结束。作为减少这样的装置等的响应等待时间的方法，例如专利文献1中公开有如下技 术通过统计处理到当前为止收集的通信状态或通信设备状态来求出异常响应的概率，基 于该异常响应的概率数据决定中止(time-out)时间。专利文献1 日本特开平11-353256号公报然而，物体识别处理所需要的时间依赖于观测装置所具备的传感器的种类及传感器观测到的环境状态，如果没有传感器的种类的信息和环境状态的信息，则无法准确判断 物体识别处理所需要的时间。其结果是，如果将物体位置推定处理定时的周期设定得相对于物体识别处理所需 要的准确的时间快，则产生物体识别处理的结果等待，另一方面，如果将物体位置推定处理 定时的周期设定得慢，则可能产生物体位置推定处理的结果等待。在此，为了加快物体位 置推定处理定时的周期，需要例如进行物体位置推定处理时的参数调整，或削减用于物体 位置推定处理的物体识别处理结果的信息量，若将物体位置推定处理定时的周期设定得过 快，则过度削减所述物体识别处理结果的信息量，导致物体位置推定精度的下降。相反，若 物体位置推定处理定时的周期设定得过慢，则只能粗略地推定物体的移动轨迹
发明内容
本发明是为了解决所述问题而提出的，其目的在于，提供如下的物体位置推定系 统、物体位置推定装置、物体位置推定方法及物体位置推定程序，即，基于观测机构观测到 的观测原始数据，事前判断物体识别处理所需要的时间，使用在从当前的时刻到下一次取 得观测原始数据的时刻的、能够进行物体识别处理的时间内能够可靠地处理未处理的观测 原始数据的参数来可靠地进行物体位置推定处理，从而同时实现实时处理和物体位置推定 的高精度化双方。为了达成所述目的，本发明如下构成。根据本发明的第一方案，提供一种物体位置推定系统，其具备观测机构，其观测包括存在于环境内的物体的所述环境的状况，从而取得第一及 第二观测原始数据；物体识别机构，其根据预先存储在物体数据库中的每个所述物体ID的物体识别 数据和所述第一及第二的观测原始数据的各自的观测原始数据，分别取得所述物体的ID 及所述物体位置备选，并将所述取得的物体的ID及所述物体位置备选的信息分别存储到 观测数据库中；物体识别处理结束时间预测机构，其根据所述第一及第二观测原始数据各自的观 测原始数据取得存在于所述环境内的所述物体的个数，并根据分别取得所述物体的个数的 时刻、所述分别取得的物体的个数、预先存储的每个所述物体分别取得所述物体的ID及所 述物体位置备选的物体识别处理所需要的时间，分别预测所述物体识别处理的预定结束时 亥IJ，将所述物体识别处理的预定结束时刻分别存储到所述观测数据库中；物体位置推定机构，其取得存储于所述观测数据库中的所述物体的ID和所述物 体位置备选，并根据所述取得的物体的ID及物体位置备选、所述物体位置备选的离散状 况，推定所述物体的位置；参数决定机构，其在所述物体识别机构结束所述第一观测原始数据的所述物体识 别处理而取得所述物体的ID及所述物体位置备选的时刻，参照存储于所述观测数据库中 的所述第二观测原始数据的所述物体识别处理的预定结束时刻，判断是否存储有从所述参 照的时刻算起所述第二观测原始数据的所述物体识别处理的预定结束时刻，在判断出存储 有所述第二观测原始数据的所述物体识别处理的预定结束时刻的情况下，参照预先存储的 每个所述物体进行推定所述物体的位置的位置推定处理所需要的时间，决定在从所述参照的时刻到所述第二观测原始数据的所述物体识别处理的预定结束时刻的时间内进行所述 物体识别处理结束了的所述第一观测原始数据的所述物体的位置推定处理的参数，另一方 面，在判断出未存储所述第二观测原始 数据的所述物体识别处理的预定结束时刻的情况 下，设定预先设定的作为基准的参数为进行所述物体识别处理结束了的所述第一观测原始 数据的所述物体的位置推定处理的参数，所述物体位置推定机构使用所述参数决定机构决定的所述参数，根据所述物体识 别处理结束的数据，进行该数据所包括的所述物体的位置推定处理，并基于所述物体识别 机构取得的所述物体的ID和位置备选推定与所述物体ID相关的所述物体的位置。根据本发明的第六方案，提供一种物体位置推定装置，其具备数据输入部，其至少能够输入进行了物体识别处理的物体的ID和位置相关的数 据、在所述数据的物体识别处理结束后输入的所述物体识别处理的预定结束时刻；观测数据库，其存储通过所述数据输入部接收的与所述物体的ID和位置相关的 数据以及与所述预定输入时刻相关的数据；物体位置推定机构，其根据存储于所述观测数据库中的与所述物体的ID和位置 相关的数据来推定所述物体的位置；参数决定机构，其参照存储于所述观测数据库中的所述物体识别处理的预定结束 时刻，判断是否存储有从所述参照的时刻算起在最早的时刻结束的所述物体识别处理的预 定结束时刻，在判断出存储有所述第二观测原始数据的所述物体识别处理的预定结束时刻 的情况下，参照预先存储的每个所述物体进行推定所述物体的位置的所述物体识别处理所 需要的时间，决定在从所述参照的时刻到所述第二观测原始数据的所述物体识别处理的预 定结束时刻的时间内进行所述物体的位置推定处理的参数，另一方面，在判断出未存储有 所述第二观测原始数据的所述物体识别处理的预定结束时刻的情况下，设定预先设定的作 为基准的参数为进行所述物体的位置推定处理的参数，所述物体位置推定机构使用所述参数决定机构决定的所述参数，根据存储于所述 观测数据库中的与所述物体的ID和位置相关的数据进行所述物体的位置推定处理，从而 推定所述物体的位置。根据本发明的第七方案，提供一种物体位置推定方法，其包括由观测机构观测环境内的状况，取得多个观测原始数据，由物体识别机构基于所述多个观测原始数据算出在所述观测机构的观测范围内 存在的物体的ID和位置而进行物体识别处理，由物体识别处理结束时间预测机构分别预测基于所述多个观测原始数据由所述 物体识别机构分别进行的所述物体识别处理结束的时刻而分别存储到观测数据库中，由参数决定机构参照存储于所述观测数据库中的所述物体识别处理的预定结束 时刻判断是否存储有从所述参照的时刻算起在最早的时刻结束的所述物体识别处理的预 定结束时刻，在判断出存储有所述第二观测原始数据的所述物体识别处理的预定结束时刻的 情况下，由所述参数决定机构参照预先存储的每个所述物体进行推定所述物体的位置的位 置推定处理所需要的时间，决定在从所述参照的时刻到所述第二观测原始数据的所述物体 识别处理的预定结束时刻的时间内进行所述物体的位置推定处理的参数，
另一方面，在判断出未存储有所述第二观测原始数据的所述物体识别处理的预定 结束时刻的情况下，由所述参数决定机构设定预先设定的作为基准的参数为进行所述物体 的位置推定处理的参数，由物体位置推定机构使用由所述参数决定机构设定的所述参数，根据通过所述物 体识别处理算出的与所述物体的ID和位置相关的数据，推定所述物体的位置。根据本发明的第八方案，提供一种物体位置推定程序，其用于使计算机实现基于由观测机构观测环境内的状况而取得的多个观测原始数据，算出在所述观测 机构的观测范围内存在的物体的ID和位置而进行物体识别处理的物体识别处理功能；预测基于所述多个观测原始数据通过所述物体识别处理功能进行的所述物体识 别处理结束的时刻而分别存储到观测数据库中的处理结束时刻预测功能；参照存储于所述观测数据库中的所述物体识别处理的预定结束时刻，判断是否存 储有从所述参照的时刻起在最早的时刻结束的所述物体识别处理的预定结束时刻，在判断 出存储有所述第二观测原始数据的所述物体识别处理的预定结束时刻的情况下，参照预先 存储的每个所述物体进行推定所述物体的位置的位置推定处理所需要的时间，决定在从所 述参照的时刻到所述第二观测原始数据的所述物体识别处理的预定结束时刻的时间内进 行所述物体的位置推定处理的参数，另一方面，在判断出未存储有所述第二观测原始数据 的所述物体识别处理的预定结束时刻的情况下，设定预先设定的作为基准的参数为进行所 述物体的位置推定处理的参数的、参数决定功能；使用由所述参数决定机构设定的所述参数，根据通过所述物体识别处理功能进行 的所述物体识别处理算出的与所述物体的ID和位置相关的数据推定所述物体的位置的物 体位置推定功能。发明效果如上所述，本发明能够提供如下物体位置推定系统、物体位置推定装置、物体位置 推定方法及物体位置推定程序，即，根据观测机构观测到的观测原始数据，在事前判断物体 识别处理所需要的时间、即得到下一次的观测数据(物体识别处理后的数据)的时间，使用 当前得到的观测数据决定进行位置的推定的物体数，由此能够在相对于观测机构的观测不 出现延迟的情况下推定物体的位置。


本发明的上述及其他目的和特征能够通过与附图相关的优选的实施方式相关连 的接下来的记述更加清楚。在该附图中，图1是表示本发明的第一及第二实施方式所涉及的物体位置推定系统的结构的 框图，图2是表示本发明的所述第一及第二实施方式所涉及的物体位置推定系统的物 体数据库的一例的图，图3是表示作为本发明的所述第一及第二实施方式所涉及的观测机构使用测域 传感器时的观测原始数据的一例图，图4是表示作为本发明的所述第一及第二实施方式所涉及的观测机构使用测域 传感器时的一观测状况例的图，
图5是表示本发明的所述第一及第二实施方式所涉及的物体位置推定系统的观 测数据库的一例的图，图6A 是表示利用能够在所述第一实施方式所涉及的物体位置推定系统中使用的 粒子过滤(particle filter)进行的物体位置推定方法的处理的流程图，图6B是表示能够在所述第二实施方式所涉及的物体位置推定系统中使用的卡尔 曼过滤(kalman filter)的处理状况例，图7是表示本发明的所述第一及第二实施方式所涉及的物体位置推定系统中的 物体观测状况例的图，图8是表示本发明的所述第一实施方式所涉及的物体位置推定结果的一例的图，图9是表示本发明的所述第一实施方式所涉及的物体位置推定系统的处理的流 程图，图10是表示本发明的所述第一实施方式所涉及的物体位置推定系统的处理的流 程图，图IlA是表示本发明的所述第一实施方式所涉及的物体位置推定系统中的粒子 数与处理时间的关系的信息的图，图IlB是根据图5所示的观测数据及观测原始数据处理预定结束时刻而推定出物 体的位置时的定时表，图12是将图IlB简化后的、本发明的所述第一实施方式所涉及的定时表图，图13是与图12进行比较的、未使用本发明时的定时表图，图14A是粒子数不同的近似精度的比较图，图14B是粒子数不同的近似精度的比较图，图15是在本发明的所述第一实施方式所涉及的物体位置推定系统中作为观测装 置使用相机时的环境背景图像的一例的说明图，图16是作为本发明的所述第一实施方式所涉及的观测装置使用相机时的相机输 入图像的一例的说明图，图17是作为本发明的所述第一实施方式所涉及的观测装置使用相机时的差量区 域的图像的一例的说明图，图18是表示本发明的第一实施方式所涉及的粒子数与处理时间的关系的信息的 一例的说明图，图19是表示本发明的第一实施方式所涉及的物体位置推定系统的UWB特征阅读 器的特征位置的测位方法的图，图20A是表示本发明的第一实施方式所涉及的物体位置推定系统的观测数据库 的一例的图，图20B是表示本发明的第一实施方式所涉及的物体位置推定系统的观测数据库 的另一例的图，图21是表示本发明的第三实施方式所涉及的物体位置推定系统的结构的框图，图22是表示本发明的第三实施方式所涉及的物体位置推定系统的显示机构的一 例的图，图23是表示本发明的第三实施方式所涉及的物体位置推定系统的显示机构的一例的图，图24是表示本发明的第三实施方式所涉及的物体位置推定系统的显示机构的一 例的图，图25是表示本发明的第三实施方式所涉及的物体位置推定系统的观测数据库的 一例的图，图26是表示记录有本发明的第一实施方式所涉及的物体位置推定系统的匹配分 数(matching score)的观测数据库的示例的图。
具体实施例方式以下，根据附图详细说明本发明所涉及的实施方式。以下，在参照附图详细说明本发明的实施方式之前，说明本发明的各种方案。根据本发明的第一方案，提供一种物体位置推定系统，其具备观测机构，其观测包括存在于环境内的物体的所述环境的状况，从而取得第一及 第二观测原始数据；物体识别机构，其根据预先存储在物体数据库中的每个所述物体的ID的物体识 别数据和所述第一及第二的观测原始数据的各自的观测原始数据，分别取得所述物体的ID 及所述物体位置备选，并将所述取得的物体的ID及所述物体位置备选的信息分别存储到 观测数据库中；物体识别处理结束时间预测机构，其根据所述第一及第二观测原始数据的各自的 观测原始数据取得存在于所述环境内的所述物体的个数，并根据分别取得所述物体的个数 的时刻、所述分别取得的物体的个数、预先存储的每个所述物体分别取得所述物体的ID及 所述物体位置备选的物体识别处理所需要的时间，分别预测所述物体识别处理的预定结束 时刻，并且将所述物体识别处理的预定结束时刻分别存储到所述观测数据库中；物体位置推定机构，其取得存储于所述观测数据库中的所述物体的ID和所述物 体位置备选，并根据所述取得的物体的ID及物体位置备选、所述物体位置备选的离散状 况，推定所述物体的位置；参数决定机构，其在所述物体识别机构结束所述第一观测原始数据的所述物体识 别处理而取得所述物体的ID及所述物体位置备选的时刻，参照存储于所述观测数据库中 的所述第二观测原始数据的所述物体识别处理的预定结束时刻，判断是否存储有从所述参 照的时刻算起的、所述第二观测原始数据的所述物体识别处理的预定结束时刻，在判断出 存储有所述第二观测原始数据的所述物体识别处理的预定结束时刻的情况下，参照预先存 储的每个所述物体进行推定所述物体的位置的位置推定处理所需要的时间，决定在从所述 参照的时刻到所述第二观测原始数据的所述物体识别处理的预定结束时刻的时间内进行 所述物体识别处理结束了的所述第一观测原始数据的所述物体的位置推定处理的参数，另 一方面，在判断出未存储所述第二观测原始数据的所述物体识别处理的预定结束时刻的情 况下，设定预先设定的作为基准的参数为进行所述物体识别处理结束了的所述第一观测原 始数据的所述物体的位置推定处理的参数， 所述物体位置推定机构使用所述参数决定机构决定的所述参数，根据所述物体识 别处理结束的数据，进行该数据包括的所述物体的位置推定处理，并基于所述物体识别机构取得的所述物体的ID和位置备选推定与所述物体ID相关的所述物体的位置。根据本发明的第二方案，在第一方案所述的物体位置推定系统的基础上，所述物体识别数据为所述物体的形状信息，所述观测原始数据是由相机摄像的图像数据，或由测域传感器取得的区域数据， 或由特征阅读器取得的位置数据。根据本发明的第三方案，在第二方案所述的物体位置推定系统的基础上，所述相 机或所述测域传感器的物体识别处理为模板匹配处理，此外，所述物体识别机构将在所述模板匹配处理的过程中输出的匹配分数记录到 所述观测数据库中，所述参数决定机构按照所述匹配分数高的顺序决定进行所述位置推定处理的物 体。根据本发明的第四方案，在第一或第二方案所述的物体位置推定系统的基础上， 所述物体位置推定机构在使用粒子过滤时预先准备每个物体的处理时间与粒子的个数的 关系信息，根据从所述参照的时刻到所述第二观测原始数据的所述物体识别处理的预定结 束时刻的时间算出由所述粒子过滤能够处理的物体的个数，在算出的物体的个数与通过所 述物体识别处理识别出的物体的个数相同时，直接使用粒子过滤进行处理，另一方面，在所述算出的物体的个数少于通过所述物体识别处理识别出的物体的 个数时，增加每个物体的所述粒子的个数而进行处理，在所述算出的物体的个数多于通过所述物体识别处理识别出的物体的个数时，减 少每个物体的所述粒子的个数而进行处理。根据本发明的第五方案，在第一 第四中任一方案所述的物体位置推定系统的基 础上，还具备显示所述物体位置推定机构推定的结果的显示机构，所述显示机构参照所述观测数据库显示下一次的物体识别处理的预定结束时刻 来作为下一次的所述物体位置推定机构的推定结果的输出时刻，并且显示为了达到输出当 前的所述物体位置推定机构的推定结果的目的而得到观测原始数据的时刻作为得到当前 的所述物体位置推定机构的推定结果的时刻。根据本发明的第六方案，提供一种物体位置推定装置，其具备数据输入部，其至少能够输入进行了物体识别处理的物体的ID和位置相关的数 据、在所述数据的物体识别处理结束后输入的所述物体识别处理的预定结束时刻；观测数据库，其存储通过所述数据输入部接收的与所述物体的ID和位置相关的 数据以及与所述预定输入时刻相关的数据；物体位置推定机构，其根据存储于所述观测数据库中的与所述物体的ID和位置 相关的数据来推定所述物体的位置；参数决定机构，其参照存储于所述观测数据库中的所述物体识别处理的预定结束 时刻，判断是否存储有从所述参照的时刻算起在最早的时刻结束的所述物体识别处理的预 定结束时刻，在判断出存储有所述第二观测原始数据的所述物体识别处理的预定结束时刻 的情况下，参照预先存储的每个所述物体进行推定所述物体的位置的所述物体识别处理所 需要的时间，决定在从所述参照的时刻到所述第二观测原始数据的所述物体识别处理的预 定结束时刻的时间内进行所述物体的位置推定处理的参数，另一方面，在判断出未存储有所述第二观测原始数据的所述物体识别处理的预定结束时刻的情况下，设定预先设定的作 为基准的参数为进行所述物体的位置推定处理的参数，所述物体位置推定机构使用所述参数决定机构决定的所述参数，根据存储于所述 观测数据库中的与所述物体的ID和位置相关的数据进行所述物体的位置推定处理，从而 推定所述物体的位置。根据本发明的第七方案，提供一种物体位置推定方法，其包括 进行由观测机构观测环境内的状况而取得多个观测原始数据的观测，由物体识别机构基于所述多个观测原始数据算出在所述观测机构的观测范围内 存在的物体的ID和位置而进行物体识别处理，由物体识别处理结束时间预测机构分别预测基于所述多个观测原始数据由所述 物体识别机构分别进行的所述物体识别处理结束的时刻而分别存储到观测数据库中，由参数决定机构参照存储于所述观测数据库中的所述物体识别处理的预定结束 时刻判断是否存储有从所述参照的时刻算起在最早的时刻结束的所述物体识别处理的预 定结束时刻，在判断出存储有所述第二观测原始数据的所述物体识别处理的预定结束时刻的 情况下，由所述参数决定机构参照预先存储的每个所述物体进行推定所述物体的位置的位 置推定处理所需要的时间，决定在从所述参照的时刻到所述第二观测原始数据的所述物体 识别处理的预定结束时刻的时间内进行所述物体的位置推定处理的参数，另一方面，在判断出未存储有所述第二观测原始数据的所述物体识别处理的预定 结束时刻的情况下，由所述参数决定机构设定预先设定的作为基准的参数为进行所述物体 的位置推定处理的参数，由物体位置推定机构使用由所述参数决定机构设定的所述参数，根据通过所述物 体识别处理算出的与所述物体的ID和位置相关的数据，推定所述物体的位置。根据本发明的第八方案，提供一种物体位置推定程序，其用于使计算机实现基于由观测机构观测环境内的状况而取得的多个观测原始数据，算出在所述观测 机构的观测范围内存在的物体的ID和位置而进行物体识别处理的物体识别处理功能；基于所述多个观测原始数据预测通过所述物体识别处理功能进行的所述物体识 别处理结束的时刻而分别存储到观测数据库中的处理结束时刻预测功能；参照存储于所述观测数据库中的所述物体识别处理的预定结束时刻，判断是否存 储有从所述参照的时刻开始在最早的时刻结束的所述物体识别处理的预定结束时刻，在判 断出存储有所述第二观测原始数据的所述物体识别处理的预定结束时刻的情况下，参照预 先存储的每个所述物体进行推定所述物体的位置的位置推定处理所需要的时间，决定在从 所述参照的时刻到所述第二观测原始数据的所述物体识别处理的预定结束时刻的时间内 进行所述物体的位置推定处理的参数，另一方面，在判断出未存储有所述第二观测原始数 据的所述物体识别处理的预定结束时刻的情况下，设定预先设定的作为基准的参数为进行 所述物体的位置推定处理的参数的、参数决定功能；使用由所述参数决定机构设定的所述参数，根据通过所述物体识别处理功能进行 的通过所述物体识别处理算出的与所述物体的ID和位置相关的数据推定所述物体的位置 的物体位置推定功能。
根据该结构，能够提供通过根据在物体位置推定处理所必要的到下一次得到观测 原始数据之前的等待时间内能够处理的物体数来决定进行物体位置推定处理的物体，从而 能够同时实现实时处理和物体位置推定的高精度化双方的物体位置推定系统、物体位置推 定装置、物体位置推定方法及物体位置推定程序。以下，参照附图详细说明本发明的第一实施方式。(第一实施方式)图1示出表示本发明的第一实施方式所涉及的物体位置推定系统的框图。本系统大致由观测机构(观测部)101和物体位置推定装置构成，用于实施物体位 置推定方法。所述物体位置推定装置由物体数据库102、物体识别机构(物体识别部)103、 识别处理结束时刻预测机构(识别处理结束时刻预测部)(以下，简称“处理结束时刻预测 机构”。)104、观测数据库105、物体位置推定机构(物体位置推定部)106和参数决定机构 (参数决定部)107构成。其中，观测机构101、物体识别机构103和处理结束时刻预测机构 104合起来能够作为至少可将与物体的ID、位置相关的数据和所述数据的预定输入时刻向 观测数据库105输入的数据输入部来进行处理。观测机构101观测包括存在于环境(成为观测对象的空间，例如生活空间(更具 体地说，起居室等房间)等)内的物体(观测物体)的环境的状况，取得观测原始数据。具 体地说，观测环境内的物体，得到观测原始数据。作为观测机构101可利用相机、测域传感 器或UWB (Ultra Wide Band)特征阅读器等来实现。在物体数据库102中存储(存储)有物体的ID的信息(以下，简称“物体的ID”) 和用于识别物体的信息。图2中示出物体数据库102的一例。在图2的物体数据库的102中 存储的信息为从“0bj_001”至“0bj_005”的物体ID和物体ID为从“Obj_001 ”至“Obj_005” 的5个的物体的各自的形状信息。在形状信息中存储有与物体的外观相关的信息和与大小 (尺寸)相关的信息。作为一例，在图2中放大表示出与物体ID “0bj_001”的物体的外观 和大小相关的信息。在此，物体ID “Obj_001”的物体由大的直径的圆柱和固定于其上的小 的直径的圆柱构成，大的直径的圆柱的直径为8cm，高度为12cm，小的直径的圆柱的直径为 4cm,高度为2cm。物体识别机构103通过对观测机构101观测到的观测原始数据进行物体识别处理 而算出观测原始数据中包括的与物体的ID和位置相关的观测数据。更具体地说，物体识别 机构103根据预先存储于物体数据库102中的每个物体的ID的用于识别物体的信息(物 体识别数据)和观测原始数据，取得物体的ID及物体位置备选，并将取得的物体的ID及物 体位置备选的信息存储到观测数据库105中。“观测原始数据”是指未对观测机构101的观 测实施任何处理的状态的数据，例如若为相机等，则相当于由相机摄像的图像数据。在为测 域传感器的情况下，相当于区域数据，在为UWB特征阅读器的情况下，相当于每个物体ID的 位置数据。另一方面，“观测 数据”是指通过对观测原始数据适用物体识别机构103而由物 体识别机构103使用观测原始数据算出的数据，是能够由物体位置推定机构106处理的与 物体的ID和位置相关的数据。关于物体识别机构103和物体位置推定机构106在后面进 行说明。在观测机构101为相机的情况下，观测原始数据为图像数据，物体识别机构103进 行由相机摄像的图像数据的图像处理。作为图像处理可以举出例如模板匹配处理等的方法。对预先取得且物体未放置于环境内时的环境的背景图像和当前的输入图像进行比较， 取出像素值不同的区域作为一个差量区域。在此需要说明的是，在由物体识别机构103作 为差量区域取出时，输入图像中可能加入噪声，因此也可以加入将预先确定的个数以上的 像素值连结起来的区域作为差量区域等制约因素。在环境中放置有N个物体(其中，N为 1个以上的整数。)的情况下，由物体识别机构103能够得到N个差量区域。之后，通过物 体识别机构103进行由物体识别机构103得到的差量区域与存储于物体数据库102中的形 状信息的外观数据(模板图像)的匹配处理，由此能够通过物体识别机构103识别物体的 ID。具体地说，将差量区域与外观数据的匹配率最高的物体作为识别结果登记到观测数据 库105中。另外，也可以将所述匹配分数(在差量区域与模板图像之间匹配的比例)也登 记到观测数据库105中。关于匹配分数的利用方法后述。此外，关于物体在环境中的位置可以通过在物体识别机构103中预先准备将图像 中的坐标与环境中的坐标对应的坐标变换式等而由物体识别机构103算出。图15中示出环境的背景图像(环境背景图像)的一例，图16中示出输入图像的 一例，图17中示出差量区域的图像的一例。在此，作为环境的一例为生活环境，是起居室 等房间110。准备的环境背景图像使用在环境内未放置任何物体的状态的背景。另外，如 图15的环境背景图像那样，在环境背景图像中可以包括几乎不会移动的书架Bs等家具或 家电设备。但是，在这种情况下，由于无法通过背景差量取出书架Bs等家具或家电设备，因 此从物体位置推定的对象中排除书架Bs等家具或家电设备。图16的输入图像表示从配置 于房间110的顶棚的相机观测到的、在餐桌Dt上放置有钱包03，在桌子Ta上放置有书O2 的状况。图17的差量区域表示在图15的环境背景图像与图16的输入图像中像素值不同 的区域，即，分别表示钱包O3的区域和书O2的区域。在此，作为一例，钱包O3为物体ID是 “0bj_003”的物体，书O2为物体ID是“0bj_002”的物体。在测域传感器401 (参照图4)代替相机作为观测机构101时，观测原始数据为区 域数据。图3中示出区域数据的一例。图3是相对于传感器401的周围360度方向以360 的分辨率取得的距离的情况下的区域数据，是在图4所示的状况下通过测域传感器401进 行观测时得到的观测结果。为了根据所述区域数据识别物体的ID，可以利用例如物体的宽 度信息来进行识别。为了简化说明，假定在从测域传感器401离开比IOOcm更远的地方只存 在壁402。此时，能够得到的距离IOOcm以内的观测值是360度中的85度 95度之间，可以 认为85度的观测值和95度的观测值是物体O1的两端。若测域传感器401的位置为(0cm， 0cm, 5cm), +X轴向为0度，+Y轴向为90度，则物体O1的两端的坐标为(sin85° X46cm， cos85 ° X 46cm) = (45.83cm, 4.01cm)和(sin95 ° X46cm，cos95 ° X 46cm)= (45. 83cm,-4. 01cm)，可以推定距设置面(测域传感器的设置位置(0cm，0cm，5cm))上部5cm 处的物体O1的宽度约为8cm。根据该物体O1的物体宽度的推定结果和存 储于物体数据库102的物体O1的形 状信息，可以判断出例如所述物体O1为ID是“0bj_001”的物体。此外，物体O1在环境中 的位置可为两端的坐标的中心值。例如，在所述例中，可以使(45. 83cm，4. Olcm)的坐标与 (45. 83cm, -4. Olcm)的坐标的中心值即(45. 83cm，Ocm)作为物体O1在环境中的位置。在观测机构101为UWB特征阅读器时，观测原始数据为每个物体ID的位置数据。 至少使用3个UWB特征阅读器。为了使用UWB特征阅读器检测物体，需要预先对物体赋予特征。例如可以使用三点测量的原理来决定使用至少3个UWB特征阅读器检测到的物体的本地坐标。图19中示出利用三点测量检测特征的位置的示例。在图19所示的环境内分 别配置有与UWB特征阅读器连接的基地站1901A、基地站1901B和基地站1901C。基地站 1901A配置于本地坐标(x，y) = (500，600)，基地站1901B配置于本地坐标(x，y) = (700， 300)，基地站1901C配置于本地坐标(x，y) = (300，300)。在此，UWB特征阅读器获知3个基 地站配置的本地坐标。并且，通过各基地站计测各基地站发射的电波从赋予给物体的特征 到返回发射的基地站的时间，能够由各基地站算出从所述发射的基地站到特征的距离。在 这样的状况下，赋予特征1902的物体存在于本地坐标(X，y) = (400，400)。基地站1901A 知晓特征1902存在于以基地站1901A的位置为中心、以到特征1902的距离223. 61cm为半 径的圆弧上。同样地，基地站1901B知晓特征1902存在于半径316. 23cm的圆弧上，基地站 1901C知晓特征1902存在于半径141. 42cm的圆弧上。能够判断出以上3个圆弧全部重合 的位置是特征1902存在的位置。在图19中进行了二维空间中的特征位置检测的说明。在 进行实空间(三维空间)中的特征位置检测时，仅图19的圆弧变为球面，其他的处理没有 变化。处理结束时刻预测机构104预先算出基于物体识别机构103的物体识别处理(在 此，作为一例为模板匹配处理)所需要的时间并存储到观测数据库105中。接下来，处理结 束时刻预测机构104通过从物体识别机构103接收物体识别机构103根据观测原始数据算 出与物体的ID和位置相关的观测数据的个数(或量)的处理算法或处理数，预测物体识别 机构103的处理预定结束时刻并存储到观测数据库105中。以下对详细情况进行说明。在物体识别机构103作为一例处理相机的观测原始数据的情况下，处理结束时刻 预测机构104在物体识别机构103取出差量图像的阶段从物体识别机构103接收得到了 几张差量图像这一信息，并根据得到了几张差量图像这一信息预测模板匹配处理所需要的 时间。例如，若对一张差量图像与5个模板进行匹配处理花费0. 2秒，则在由物体识别机构 103得到五张差量图像的情况下，模板匹配处理所需要的时间为1秒。此时，处理预定结束 时刻为0. 2秒X5 = 1. 0秒，因此为取出背景差量的时刻的1秒后。即，处理结束时刻预测 机构104预先算出物体识别处理(在此，模板匹配处理)所需要的时间。在此，如图1所示，将观测机构101、物体数据库102、物体识别机构103和处理结 束时刻预测机构104汇总称为一个观测装置500。此外，在将观测装置500单独进行区别 时，称为第一观测装置501、第二观测装置502、第三观测装置503、……、第η观测装置(其 中，η为1以上的整数。)。在观测数据库105中存储有观测装置500的ID的信息(以下，简称“观测装置的 ID”。以下，为了方便，将第一 第三观测装置501、502、503的ID分别设为“501”、“502”、 “503”。)、与观测物体ID和在该环境中的观测物体的位置(例如位置坐标)相关的观测数 据、观测原始数据处理预定结束时刻(例如年月日和时分秒)。在此，对数据分别通过物体识别机构103及处理结束时刻预测机构104存储到观 测数据库105中的流程进行说明。首先，观测机构101在环境内进行观测，得到观测原始数据。接下来，通过处理结束时刻预测机构104算出物体识别机构103处理观测原始数据所需要的时间(观测原始数据处理预定结束时刻)，并在观测数据库105中作为原始数据 处理预定结束时刻而与包括取得观测原始数据的观测机构101的观测装置501、502、503的 ID 一起存储到观测数据库105中。接下来，使用由观测机构101得到的观测原始数据，在物体识别机构103中开始物 体识别处理。然后，物体识别机构103在结束观测原始数据的物体识别处理时将观测数据与观 测装置501、502、503的ID —起存储到观测数据库105中。图5示出观测数据库105的一例。 图5的(a)图示出表示在2007年9月11日14时17分20秒这一时间点的观测数 据库105的数据存储状况的数据表(表示该数据存储状况的数据表的ID为“TBL_001”。)。 图5的(b)图示出表示在其6秒后的14时17分26秒这一时间点的数据存储状况(表示该 数据状况的数据表的ID为“TBL_002”。)的数据表。在图5的(b)中，与图5的(a)相比追 加了下数第一行和第二行的数据。图5的(c)图示出表示自图5的(b)的状况8秒后的14 时17分34秒这一时间点的数据存储状况(表示该数据状况的数据表的ID为“TBL_003”。) 的数据表。在图5的(c)中，与图5的(b)相比追加了下数第一行和第二行的数据。在图5的(a)的数据表ID “TBL_001”的数据表中，分别存储有来自结束了物体识 别处理的观测装置ID501的观测数据“0bj_001 (65，20) ”、“0bj_002 (120，26)，，和来自预测 出处理预定结束时刻“14时17分26秒”、“14时17分34秒”的观测装置ID502、503的观 测原始数据处理的预定结束时刻。在图5的(b)的数据表ID “TBL_002”的数据表中，从观测装置ID503如观测原 始数据处理预定结束时刻那样分别存储有观测数据“Ob j_004 (266，37)，，和“Ob j_005 (322， 21) ”(参照数据表的下数第二行)，从观测装置ID501存储有新的观测原始数据的物体识别 处理的预定结束时刻(参照数据表的下数第一行)。关于图5的(c)的数据表ID“TBL_003” 的数据表也同样。即，在图5的(c)的数据表ID “TBL_003”的数据表中，从观测装置 10502如观测原始数据处理预定结束时刻那样存储有观测数据“01^__002(119，28)”和 "0bj_005 (322，21) ”(参照数据表的下数第二行参照)，从观测装置ID503存储有新的观测 原始数据处理的预定结束时刻(参照数据表的下数第一行)。图26中示出记录有观测物体位置和所述的匹配分数的观测数据库105的示例。在图26的数据表ID“TBL_007”的数据表记录有观测ID、观测物体位置、原始数据 处理预定结束时刻、观测时刻以及匹配分数。在匹配分数的项目中记录有识别的物体的ID和分数。例如，匹配分数 "0bj_001 (0. 8) ”表示检测物体所得到的差量区域与物体“Obj_001”的模板的匹配分数(匹 配的比例)为80%。物体位置推定机构106根据由参数决定机构107指定且存储于观测数据库105中 的与物体的ID和物体位置备选相关的观测数据，考虑物体位置备选的离散状况(例如，物 体的位置和加权)等(具体地说，使用粒子过滤或卡尔曼过滤)来推定物体的位置。在此，对物体位置推定机构106推定的物体的位置与存储于观测数据库105中的 位置备选的差异进行说明。存储于观测数据库105中的所述物体的位置是各观测装置501、 502,503逐个算出的位置，由于各观测装置501、502、503中含有的噪声等引起的位置误差，各观测装 置501、502、503中通常各不相同，因此作为所述物体位置备选来处理。与此相对， 物体位置推定机构106推定的物体的位置意味着通过物体位置推定处理从所述物体位置 备选中推定的存在概率最高的位置，两者明显不同。此外，以下对参数决定机构107进行说明。物体位置推定机构106的物体 位置推定处理作为一例可以使用粒子过滤来实现(例如，参照文献J. Hightower， B. Borriel Ιο. “ The location Stack :A Layered Model for Location in Ubiquitous Computing，，，4th IEEE Workshop on Mobile Computing Systems & Applications (WMCSA2002)，pp. 22-28. 2002.)。“粒子过滤”是用具有状态量和权重的许多 粒子对概率分布进行近似的方法，即使为非线形的分布也能够进行近似。在此，“状态量”表 示物体的位置。此外，全部粒子的权重的和为1，粒子的个数预先设定。根据图6A对通过物体位置推定机构106使用粒子过滤来实现的物体位置推定方 法进行。在图6A的第一步骤Sl中，通过物体位置推定机构106根据上次的各粒子的权重 进行粒子的再采样。其中，第一次由物体位置推定机构106在环境内随机生成粒子。接下来，在第二步骤S2中，通过物体位置推定机构106对各粒子进行从上次位置 到当前位置的预测。接下来，在第三步骤S3中，通过物体位置推定机构106根据由观测数据得到的物 体的存在位置概率计算各粒子的权重。接下来，在第四步骤S4中，通过物体位置推定机构106求出全部粒子的加权平均， 并由物体位置推定机构106将求出的加权平均定为物体的推定位置。然而，利用使用粒子过滤的物体位置推定方法，存在下述问题一方面粒子的个数 越多近似的精度越高，但物体位置推定处理所需要的计算时间变长，另一方面粒子的个数 越少物体位置推定处理所需要的计算时间越短，但近似的精度变低。图14A是使用15个粒 子进行钱包的位置推定的示例(图14A的1个的黑圆表示1个粒子。)，图14B示出使用30 个粒子来进行钱包的位置推定的示例。这些粒子的坐标分别为物体位置备选。观察图14A 可知，能够判别出钱包很可能位于15个粒子的中心附近的坐标(4000,4000)。然而，观察 图14B可知，由于粒子数多而近似精度变高，因此能够判别出除坐标(4000,4000)以外，还 存在钱包位于坐标(5000,5000)的概率。这些的坐标为物体位置备选。参数决定机构107使用观测原始数据处理(物体识别处理)预定结束时刻、当前 的时刻、物体位置推定机构106的处理能力和当前未处理的观测数据各信息，从当前的时 刻到观测原始数据处理预定结束时刻决定能够处理未处理观测数据的粒子的个数。另外，在参数决定机构107的内部具有计时器，能够取得当前的时刻等时刻的信 息，观测原始数据处理预定结束时刻存储于观测数据库105中。在由参数决定机构107决定的粒子数相对于例如上次的处理中使用的粒子数来 说粒子数多的情况下，可以通过参数决定机构107将增加的量的粒子一样地散布到环境 内，也可以根据原来的各粒子的权重来散布。相反地，在由参数决定机构107决定的粒子数 相对于上次的处理中使用的粒子数少的情况下，可以通过参数决定机构107从上次的位置 推定结果即粒子的分布随机删除减少的量的粒子数，或者也可以根据原来的各粒子的权重 来删除。
另外，以下对参数决定机构107的参数决定处理(参数设定处理)进行说明。参数决定机构107在存储于观测数据库105中的物体识别机构103的物体识别 处理结束的时刻与当前的时刻的时间差内，决定能够处理未处理的观测数据即物体的粒子数。在此，图IlA中示出粒子数与物体识别处理所需要的时间的关系的信息(关系信 息)的一例。该关系信息例如存储于参数决定机构107的内部存储部。图IlA示出在例如 使用100个粒子来适用粒子过滤的情况下，进行1个物体的位置推定需要0. 8秒的时间，以 下，示出在分别使用200个、300个、500个、1000个粒子来适用粒子过滤的情况下，作为处理 速度，进行1个物体的位置推定分别需要1秒、2秒、3秒、5秒的时间。另外，图IlA所示的 关系的信息是通过事前实验预先得到的。对通过参数决定机构107利用图IlA的关系信息和图5的(a)的数据表 ID “TBL_001”的数据表来决定粒子数的方法进行说明。首先，由参数决定机构107判断相对于当前的时刻，下一次存储观测数据的时刻 是否存储到图5的观测数据库105中，若参数决定机构107判断出下一次存储观测数据的 时刻存储到观测数据库105，则进行以下的动作。例如，图5的(a)所示当前的时刻为17 分20秒(在此，为了简化说明，省略年月日时。)，若参照存储于观测数据库105中的信 息，则下一次存储观测数据的时刻为17分26秒(参照图5的(b))。在当前的时刻17分 20秒的未处理的观测数据为由第一观测装置501取得的与第一观测物体相关的观测数据 “01^_001”和与第二观测物体相关的观测数据“01^_002”这2个(参照图5的(a)的第二 行)，通过处理结束预测机构104可算出到下一次存储观测数据(在该例中，由第三观测装 置503取得的第四观测物体和第五观测物体的各自的观测数据)(到存储图5的(b)的数 据表ID “TBL_002”的数据表为止)存在(当前的时刻17分20秒)-(下一次的时刻17 分26秒)=6秒的富余。此时，由于在当前的时间点的未处理的观测数据为2个物体，因 此根据6秒/2个=3秒，能够通过参数决定机构107算出每一个物体花费的处理时间为3 秒以内。由此，根据图IlA的关系信息，能够由参数决定机构107设定(决定)出每一个物 体可用3秒处理的(以每一个物体3秒的处理速度的)粒子数为500个。由此，能够通过参数决定机构107根据物体位置推定机构106处理的观测数据数 和到下一次存储观测数据存储的时间来设定(决定)粒子过滤的粒子数，通过物体位置推 定机构106使用由参数决定机构107设定的500个粒子，使用粒子过滤来进行2个物体的 位置推定。其结果是，能够在物体位置推定处理所必要的到存储下一次的观测数据位置的 等待时间内结束所述观测原始数据的物体识别处理。换言之，能够在不相对于观测机构101 的观测出现延迟的情况下推定物体的位置。
在此，在由参数决定机构107判断出下一次记录观测数据的时间(观测原始数据 处理预定结束时刻)尚未存储到图5的观测数据库105中的情况下，参数决定机构107决 定粒子的个数为事前决定的成为基准的粒子数(例如，200个)。表示观测数据库的一例的图20A的“TBL_004”示出在未记录观测原始数据处理 预定结束时刻的状况下，已记录观测数据的观测数据库105的示例。如上述那样，在得到 了 “TBL_004”中所示数据的情况下，参数决定机构107决定粒子的个数为事前决定的成为 基准的粒子数，推定物体的位置。在此，表示观测数据库的另一例的图20B的“TBL_005”示出使用所述“TBLJKM”中所示的数据来推定物体的位置后的观测数据库105的示例。在 “TBL_005” 中，观测装置 503 输出的观测值 “Ob j_004 066，37) ”、“Ob j_005 (322，21) ”和观 测装置 502 输出的观测值“01^__002(119，28) ”、“Ob j_003 (197，69) ”、“Ob j_004 (266，36)，，这 共计5个观测数据作为未处理的观测数据存在。此外，当前时刻为2007年9月11日14时 17分34秒，下一次记录观测数据的时刻为2007年9月11日14时17分38秒。S卩，参数决 定机构107决定在到记录下一次观测数据的4秒期间能够处理5个观测数据的粒子数。此外，时间单位不局限于秒，例如，也可以将“到下一次存储观测数据”的时间分开 表示为“花费较多时间”的情况、“花费中等时间”的情况和“仅花费较少时间”的情况等多 个阶段(例如，在此为3阶段)，粒子数和每一个物体的处理时间的关系信息也与此配合而 作成。在图18中示出此时的粒子数与处理时间的关系信息。在图18中，例如，在“花费较 多时间”(在图18中表现为“长”。)的情况下粒子数为300个，在“花费中等时间”(在图 18中表现为“中等”。)的情况下粒子数为200个(基准粒子数)，在“仅花费较短时间”(在 图18中表现为“短”。)的情况下粒子数为100个。也可以通过参数决定机构107根据这 样的关系信息来设定粒子的个数。根据所述第一实施方式，能够通过参数决定机构107根据物体位置推定机构106 处理的观测数据数和到下一次存储观测数据的时间来变更粒子过滤的粒子数。即，作为基 准或初期的设定，在参数决定机构107的内部存储部预先存储从当前的时刻到下一次存储 观测数据的时刻的观测原始数据能够处理时间和在该观测原始数据能够处理时间中能够 处理的粒子数的关系信息。并且，在从当前的时刻到下一次存储观测数据的时刻的观测原 始数据能够处理时间比规定时间短的情况下，通过参数决定机构107减少粒子数使其比与 规定时间对应的粒子数少而削减物体识别处理所需要的时间，另一方面，在从当前的时刻 到下一次存储观测数据的时刻的观测原始数据能够处理时间比所述规定时间长的情况下， 增加粒子数使其比所述规定数多而能够高精度地推定物体的位置。由此，能够在物体位置 推定处理所必要的到下一次存储观测数据的等待时间内可靠地结束所述观测原始数据的 物体识别处理。(第二实施方式)图1是表示本发明的第二实施方式所涉及的物体位置推定系统的框图。S卩，第二 实施方式所涉及的物体位置推定系统的大致结构与第一实施方式所涉及的物体位置推定 系统同样，如后述那样，仅物体位置推定机构106和参数决定机构107功能不同。本系统由观测机构101、物体数据库102、物体识别机构103、处理结束时刻预测机 构104、观测数据库105、物体位置推定机构106和参数决定机构107构成。物体位置推定机构106和参数决定机构107以外的各机构及各数据库与在第一实 施方式中说明的功能相同，因此省略说明。作为物体位置推定机构106，可以代替粒子过滤而使用例如卡尔曼过滤等。“卡尔 曼过滤”是指在系统的状态(在本发明的第二实施方式中，例如为物体位置)的信息中含有 噪声且在观测值中也含有噪声的情况下，从系统的能够获取的状态的备选中推定概率最高 的状态的方法。图6B中示出在物体位置推定处理利用了卡尔曼过滤的示例。纵轴表示概 率，横轴表示位置。在物体如下述的(式1)的式中表示那样移动时，观测机构101能够得到由下述的(式幻的式求出的观测值603。在此，A表示物体的运动模型，χ表示物体位置，ν表示在移 动时产生的工艺噪声。此外，y表示观测值，H表示使物体位置χ与观测值y对应的观测模 型，w表示观测噪声，t表示时间。式1

xt = AtXt^1+Vt式2yt = Htxt+wt在此，若工艺噪声ν及观测噪声w为白色高斯噪声，则ρ (w)如(式3)的式子所示， P (ν)如(式4)的式子所示。另外，N(0, Q)表示平均0、方差Q的高斯分布。N(0，R)也同 样表示平均0、方差R的高斯分布。式3p(w) N(0，Q)式4p(v) N(0，R)在得到观测值603时，由物体位置推定机构106更新当前得到的与物体的位置相 关的事前概率分布601 (以后，称为“事前分布”。)，由物体位置推定机构106作出预测分布 602。能够由物体位置推定机构106利用(式幻的式子求出预测分布602的位置，由物体 位置推定机构106利用(式6)的式子求出预测分布602的方差。另外，"Xalb”表示根据时 刻b的信息得出的时刻a的X的推定值。例如，(式5)的“χ*/’表示根据时刻t-Ι的信 息得出的时刻t的物体位置χ的推定值，(式6)的"Ptlt^表示根据时刻t-Ι的信息得出 的时刻t的P的推定值。在此，P表示分布的方差。式5XtlH = AjHlH式6PiIf-I ~ ^ifPf—取-I + Qi在通过物体位置推定机构106得到预测分布602时，由物体位置推定机构106根 据观测值603和预测分布602求出事后分布604。能够由物体位置推定机构106利用(式 7)的式子求出事后分布604的位置，由物体位置推定机构106利用(式8)的式子求出事后 分布604的方差。在此，K是称为卡尔曼增益的值，通过(式9)的式子求出。卡尔曼增益 是决定更新量的值。在观测值的精度好(方差R非常小)的情况下，为了增大更新量，卡尔 曼增益的值变大。相反，在事前分布的精度良好(P非常小)的情况下，为了减小更新量，卡 尔曼增益的值变小。式7Xtlt = xt|t-!+Kt (Yt-HtXtjw)式8Ptlt= (I-KtHt)PtIt-I式920
权利要求
1.一种物体位置推定系统，其具备观测机构，其观测包括存在于环境内的物体在内的所述环境的状况，取得第一及第二 观测原始数据；物体识别机构，其根据预先存储在物体数据库中的每个所述物体ID的物体识别数据 和所述第一及第二的观测原始数据各自的观测原始数据，分别取得所述物体ID及所述物 体位置备选，并将取得的所述物体ID及所述物体位置备选的信息分别存储到观测数据库 中；物体识别处理结束时间预测机构，其从所述第一及第二观测原始数据各自的观测原始 数据取得存在于所述环境内的所述物体的个数，并根据分别取得所述物体的个数的时刻、 分别取得的所述物体的个数、和预先存储的每个所述物体分别取得所述物体ID及所述物 体位置备选的物体识别处理所需要的时间，分别预测所述物体识别处理的预定结束时刻， 并将所述物体识别处理的预定结束时刻分别存储到所述观测数据库中；物体位置推定机构，其取得存储到所述观测数据库中的所述物体ID和所述物体位置 备选，并根据取得的所述物体ID及物体位置备选、所述物体位置备选的离散状况，推定所 述物体的位置；和参数决定机构，其在所述物体识别机构结束所述第一观测原始数据的所述物体识别处 理而取得所述物体ID及所述物体位置备选的时刻，参照存储到所述观测数据库中的所述 第二观测原始数据的所述物体识别处理的预定结束时刻，判断从所述参照的时刻起是否存 储有所述第二观测原始数据的所述物体识别处理的预定结束时刻，在判断出存储有所述第 二观测原始数据的所述物体识别处理的预定结束时刻的情况下，参照预先存储的每个所述 物体进行推定所述物体的位置的位置推定处理所需要的时间，决定在从所述参照的时刻到 所述第二观测原始数据的所述物体识别处理的预定结束时刻的时间内进行所述物体识别 处理结束了的所述第一观测原始数据的所述物体的位置推定处理的参数，另一方面，在判 断出未存储所述第二观测原始数据的所述物体识别处理的预定结束时刻的情况下，设定预 先设定的成为基准的参数为进行所述物体识别处理结束了的所述第一观测原始数据的所 述物体的位置推定处理的参数，所述物体位置推定机构使用所述参数决定机构决定的所述参数，从所述物体识别处理 结束的数据进行该数据所包含的所述物体的位置推定处理，并根据所述物体识别机构取得 的所述物体ID和位置备选推定与所述物体ID相关的所述物体的位置。
2.根据权利要求1所述的物体位置推定系统，其中，所述物体识别数据为所述物体的形状信息，所述观测原始数据是由相机摄像的图像数据、由测域传感器取得的区域数据、或由特 征阅读器取得的位置数据。
3.根据权利要求2所述的物体位置推定系统，其中，所述相机或所述测域传感器的物体识别处理为模板匹配处理，而且，所述物体识别机构将在所述模板匹配处理的过程中输出的匹配分数记录到所述 观测数据库中，所述参数决定机构按照所述匹配分数高的顺序决定进行所述位置推定处理的物体。
4.根据权利要求1或2所述的物体位置推定系统，其中，所述物体位置推定机构在使用粒子过滤时预先准备每一个物体的处理时间与粒子的 个数的关系信息，根据从所述参照的时刻到所述第二观测原始数据的所述物体识别处理的 预定结束时刻的时间算出由所述粒子过滤能够处理的物体的个数，若算出的物体的个数与 通过所述物体识别处理识别出的物体的个数相同，则直接使用粒子过滤进行处理，在所述算出的物体的个数少于通过所述物体识别处理识别出的物体的个数时，增加每 一个物体的所述粒子的个数而进行处理，在所述算出的物体的个数多于通过所述物体识别处理识别出的物体的个数时，减少每 一个物体的所述粒子的个数而进行处理。
5.根据权利要求1 4中任一项所述的物体位置推定系统，其中， 还具备显示所述物体位置推定机构推定的结果的显示机构，所述显示机构参照所述观测数据库显示下一次的物体识别处理的预定结束时刻来作 为下一次的所述物体位置推定机构的推定结果的输出时刻，并且，显示为了输出当前的所 述物体位置推定机构的推定结果而采用的观测原始数据被得到的时刻作为得到当前的所 述物体位置推定机构的推定结果的时刻。
6.一种物体位置推定装置，其具备数据输入部，其至少能够输入进行了物体识别处理的与物体的ID和位置相关的数据、 在所述数据的物体识别处理结束后输入的所述物体识别处理的预定结束时刻；观测数据库，其存储通过所述数据输入部接收的与所述物体的ID和位置相关的数据 以及与所述预定输入时刻相关的数据；物体位置推定机构，其根据存储到所述观测数据库中的与所述物体的ID和位置相关 的数据来推定所述物体的位置；和参数决定机构，其参照存储到所述观测数据库中的所述物体识别处理的预定结束时 亥IJ，判断是否存储有从所述参照的时刻起在最早的时刻结束的所述物体识别处理的预定结 束时刻，在判断出存储有所述第二观测原始数据的所述物体识别处理的预定结束时刻的情 况下，参照预先存储的每个所述物体进行推定所述物体的位置的所述物体识别处理所需要 的时间，决定在从所述参照的时刻到所述第二观测原始数据的所述物体识别处理的预定结 束时刻的时间内进行所述物体的位置推定处理的参数，另一方面，在判断出未存储有所述 第二观测原始数据的所述物体识别处理的预定结束时刻的情况下，设定预先设定的成为基 准的参数为进行所述物体的位置推定处理的参数，所述物体位置推定机构使用所述参数决定机构决定的所述参数，根据存储到所述观测 数据库中的与所述物体的ID和位置相关的数据进行所述物体的位置推定处理，从而推定 所述物体的位置。
7.—种物体位置推定方法，其包括由观测机构观测环境内的状况，取得多个观测原始数据，由物体识别机构基于所述多个观测原始数据算出在所述观测机构的观测范围内存在 的物体的ID和位置而进行物体识别处理，由物体识别处理结束时间预测机构分别预测由所述物体识别机构基于所述多个观测 原始数据分别进行的所述物体识别处理结束的时刻而分别存储到观测数据库中，由参数决定机构参照存储到所述观测数据库中的所述物体识别处理的预定结束时刻判断是否存储有从所述参照的时刻起在最早的时刻结束的所述物体识别处理的预定结束 时刻，在判断出存储有所述第二观测原始数据的所述物体识别处理的预定结束时刻的情况 下，由所述参数决定机构参照预先存储的每个所述物体进行推定所述物体的位置的位置推 定处理所需要的时间，决定在从所述参照的时刻到所述第二观测原始数据的所述物体识别 处理的预定结束时刻的时间内进行所述物体的位置推定处理的参数，另一方面，在判断出未存储有所述第二观测原始数据的所述物体识别处理的预定结束 时刻的情况下，由所述参数决定机构设定预先设定的成为基准的参数为进行所述物体的位 置推定处理的参数，物体位置推定机构使用由所述参数决定机构设定的所述参数，根据通过所述物体识别 处理算出的与所述物体的ID和位置相关的数据，推定所述物体的位置。
8. —种物体位置推定程序，其用于使计算机实现物体识别处理功能，基于观测机构观测环境内的状况而取得的多个观测原始数据，算 出在所述观测机构的观测范围内存在的物体的ID和位置而进行物体识别处理；处理结束时刻预测功能，预测所述物体识别处理功能基于所述多个观测原始数据进行 的所述物体识别处理结束的时刻而分别存储到观测数据库中；参数决定功能，参照存储到所述观测数据库中的所述物体识别处理的预定结束时刻， 判断是否存储有从所述参照的时刻起在最早的时刻结束的所述物体识别处理的预定结束 时刻，在判断出存储有所述第二观测原始数据的所述物体识别处理的预定结束时刻的情况 下，参照预先存储的每个所述物体进行推定所述物体的位置的位置推定处理所需要的时 间，决定在从所述参照的时刻到所述第二观测原始数据的所述物体识别处理的预定结束时 刻的时间内进行所述物体的位置推定处理的参数，另一方面，在判断出未存储有所述第二 观测原始数据的所述物体识别处理的预定结束时刻的情况下，设定预先设定的成为基准的 参数为进行所述物体的位置推定处理的参数；和 物体位置推定功能，使用由所述参数决定机构设定的所述参数，根据所述物体识别处 理功能的所述物体识别处理算出的与所述物体的ID和位置相关的数据推定所述物体的位 置。
全文摘要
本发明提供物体位置推定系统、物体位置推定装置、物体位置推定方法及物体位置推定程序。对观测部(101)观测到的多个观测原始数据进行物体识别处理，使用参数决定部(107)与一个数据的物体识别处理结束时间点和另一数据的处理预定结束时刻之间的时间相对应决定的参数，根据物体识别处理结束的数据进行物体的位置推定处理，基于物体识别部(103)取得的物体ID和位置备选来推定与物体ID相关的物体的位置。
文档编号G01S5/00GK102047073SQ20098011910
公开日2011年5月4日 申请日期2009年10月30日 优先权日2008年11月5日
发明者谷川彻 申请人:松下电器产业株式会社