# US 12,183,206 B2 · Motion state determination apparatus of vehicle > Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt - Number: US 12,183,206 B2 - Document ID: US12183206B2 - Status: Granted - Kind: B2 - Application number: 17/298,067 - Filed: 2019-01-18 - Published: 2022-04-21 - Granted: 2024-12-31 - Earliest claimed: 2019-01-18 - Assignees: Mitsubishi Electric Corporation - Applicants: Mitsubishi Electric Corporation - Inventors: Kyosuke Konishi - Web page: https://patentgrep.com/patent/US12183206B2 ## CPC - G01C 21/28: with correlation of data from several navigational instruments - G08G 1/166: {for active traffic, e.g. moving vehicles, pedestrians, bikes} - G01C 21/3461: {Preferred or disfavoured areas, e.g. dangerous zones, toll or emission zones, intersections, manoeuvre types or segments such as motorways, toll roads or ferries} - G01C: MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY (measuring liquid level G01F; radio navigation, determining distance or velocity by use of propagation effects, e.g. Doppler effects, propagation time, of radio waves, analogous arrangements using other waves G01S) - G08G: TRAFFIC CONTROL SYSTEMS (guiding railway traffic, ensuring the safety of railway traffic B61L; arrangement of road signs or traffic signals E01F9/00; radar or analogous systems, sonar systems, lidar systems specially adapted for traffic control G01S13/91, G01S15/88, G01S17/88; {radar or analogous systems, sonar systems, lidar systems specially adapted for anti-collision purposes G01S13/93, G01S15/93, G01S17/93}) ## Abstract A motion state determination apparatus according to the present disclosure includes a sensor for obtaining observation data on a target object, a route data storage unit, a route component predictor that calculates component parallel and vertical to the route of a motion-dimension prediction value and a prediction error, a first coordinate transformer that transforms a motion-dimension prediction value and a prediction error into those on a coordinate system the same as a first coordinate system, a filter that calculates a motion-dimension estimation value and an estimation error, a second coordinate transformer that transforms a motion-dimension estimation value and an estimation error into a component parallel to the route and a component vertical to the route and a motion-dimension prediction value and a prediction error, and a state determinator that determines a motion state of the target object. As a result, the frequency of an erroneous determination can be decreased. ## Claims ### Claim 1 A motion state determination apparatus of a vehicle comprising: a sensor that is mounted in the vehicle and configured to obtain observation data on motion dimensions including at least a position among a position, a speed, and acceleration of a target object in a first coordinate system whose coordinate axes are an anteroposterior direction and a transverse direction of the vehicle; a memory that stores route data indicating a shape of a route on which the target object can move; and a processor configured to execute instructions stored in the memory to: calculate a prediction value for the motion dimension of the target object in a route on which the target object is traveling and a prediction value for an error in the motion dimension thereof; calculate a component parallel to the route and a component vertical to the route of each of a prediction value for the motion dimension off the target object and a prediction value for an error in the motion dimension thereof in a second coordinate system whose coordinate axes are a direction parallel to the route and a direction vertical to the route; perform a first coordinate transformation to transform a component parallel to the route and a component vertical to the route of each of a prediction value for the motion dimension of the target object and a prediction value for an error, in the motion dimension thereof into a component in an anteroposterior direction of the vehicle and a component in a transverse direction of the vehicle in the first coordinate system; calculate an estimation value for the motion dimension of the target object and an estimation value for an error in the motion dimension thereof in the first coordinate system, based on the observation data of the target object in the first coordinate system, a prediction value for the motion dimension of the target object, a prediction value for an error in the motion dimension thereof, and the route data stored in the memory; perform a second coordinate transformation to transform an estimation value for the motion dimension of the target object and an estimation value for an error in the motion dimension thereof in the first coordinate system into an estimation value for the motion dimension of the subject and an estimation value for an error in the motion dimension thereof in the second coordinate system; determine a motion state of the target object, based on a component parallel to the route and a component vertical to the route of each of an estimation value for the motion dimension of the target object and an estimation value for an error in the motion dimension thereof in the second coordinate system; and determine whether or not the target object is meandering. ### Claim 2 (depends on 1) The motion state determination apparatus according to claim 1, wherein the processor is further configured to: calculate respective components parallel to the route of each of a prediction value for the motion dimension of the target object and a prediction value for an error, in the motion dimension thereof; and calculate respective components vertical to the route of each of a prediction value for the motion dimension of the target object and a prediction value for an error in the motion dimension thereof. ### Claim 3 (depends on 1) The motion state determination apparatus according to claim 1, wherein the processor is further configured to: set respective different motion models in the direction parallel to the route and in the direction vertical to the route; and calculate the component parallel to the route of each of a prediction value for the motion dimension and a prediction value for an error in the motion dimension and a component vertical to the route of each of a prediction value for the motion dimension and a prediction value for an error in the motion dimension. ### Claim 4 (depends on 1) The motion state determination apparatus according to claim 1, wherein the processor is further configured to: calculate the component parallel to the route and the component vertical to the route of each of a prediction value for the motion dimension and a prediction value for an error in the motion dimension of each of N pieces of the target objects, wherein N is a predetermined number; perform the first coordinate transformation in which a prediction value for each of N sets of the motion dimensions and a prediction value for an error in each of the N sets of the motion dimensions are transformed into values in the first coordinate system; calculate an estimation value for the motion dimension of the target object and an estimation value for an error in the motion dimension thereof of each of a prediction value for each of N sets of the motion dimensions and a prediction value for an error in each of the N sets of the motion dimension, wherein said prediction values have been transformed through the first coordinate transformation; perform the second transformation in which an estimation value for the motion dimension and an estimation value for an error in the motion dimension of each of N sets of subjects are transformed into a component parallel to the route and a component vertical to the route in the second coordinate system; and determine the motion state of the target object, by use of an estimation value for the motion dimension and an estimation value for an error in the motion dimension of each of N pieces of the target objects, wherein said estimation values have been transformed through the second coordinate transformation. ### Claim 5 (depends on 1) The motion state determination apparatus according to claim 1, wherein the processor is further configured to: set respective different motion models for a prediction value for the motion dimension and a prediction value for an error in the motion dimension of each of N sets of the target objects; and calculate the component parallel to the route and the component vertical to the route, wherein N is a predetermined number. ### Claim 6 (depends on 2) The motion state determination apparatus according to claim 2, wherein the processor is further configured to: set respective different motion models in the direction parallel to the route and in the direction vertical to the route; and calculate the component parallel to the route of each of a prediction value for the motion dimension and a prediction value for an error in the motion dimension and a component vertical to the route of each of a prediction value for the motion dimension and a prediction value for an error in the motion dimension. ### Claim 7 (depends on 2) The motion state determination apparatus according to claim 2, wherein the processor is further configured to: calculate the component parallel to the route and the component vertical to the route of each of a prediction value for the motion dimension and a prediction value for an error in the motion dimension of each of N pieces of the target objects, wherein N is a predetermined number: perform the first coordinate transformation in which a prediction value for each of N sets of the motion dimensions and a prediction value for an error in each of the N sets of the motion dimensions are transformed into values in the first coordinate system; calculate an estimation value for the motion dimension of the target object and an estimation value for an error in the motion dimension thereof of each of a prediction value for each of N sets of the motion dimensions and a prediction value for an error in each of the N sets of the motion dimension, wherein said prediction values have been transformed through the first coordinate transformation; perform the second transformation in which an estimation value for the motion dimension and an estimation value for an error in the motion dimension of each of N sets of subjects are transformed into a component parallel to the route and a component vertical to the route in the second coordinate system; and determine the motion state of the target object, by use of an estimation value for the motion dimension and an estimation value for an error in the motion dimension of each of N pieces of the target objects, wherein said estimation values have been transformed through the second coordinate transformation. ### Claim 8 (depends on 3) The motion state determination apparatus according to claim 3, wherein the processor is further configured to: calculate the component parallel to the route and the component vertical to the route of each of a prediction value for the motion dimension and a prediction value for an error in the motion dimension of each of N pieces of the target objects, wherein N is a predetermined number; perform the first coordinate transformation in which a prediction value for each of N sets of the motion dimensions and a prediction value for an error in each of the N sets of the motion dimensions are transformed into values in the first coordinate system; calculate an estimation value for the motion dimension of the target object and an estimation value for an error in the motion dimension thereof of each of a prediction value for each of N sets of the motion dimensions and a prediction value for an error in each of the N sets of the motion dimension, wherein said prediction values have been transformed through the first coordinate transformation; perform the second transformation in which an estimation value for the motion dimension and an estimation value for an error in the motion dimension of each of N sets of subjects are transformed into a component parallel to the route and a component vertical to the route in the second coordinate system; and determine the motion state of the target object, by use of an estimation value for the motion dimension and an estimation value for an error in the motion dimension of each of N pieces of the target objects, wherein said estimation values have been transformed through the second coordinate transformation. ### Claim 9 (depends on 6) The motion state determination apparatus according to claim 6, wherein the processor is further configured to: calculate the component parallel to the route and the component vertical to the route of each of a prediction value for the motion dimension and a prediction value for an error in the motion dimension of each of N pieces of the target objects, wherein N is a predetermined number; perform the first coordinate transformation in which a prediction value for each of N sets of the motion dimensions and a prediction value for an error in each of the N sets of the motion dimensions are transformed into values in the first coordinate system; calculate an estimation value for the motion dimension of the target object and an estimation value for an error in the motion dimension thereof of each of a prediction value for each of N sets of the motion dimensions and a prediction value for an error in each of the N sets of the motion dimension, wherein said prediction values have been transformed through the first coordinate transformation; perform the second transformation in which an estimation value for the motion dimension and an estimation value for an error in the motion dimension of each of N sets of subjects are transformed into a component parallel to the route and a component vertical to the route in the second coordinate system; and determine the motion state of the target object, by use of an estimation value for the motion dimension and an estimation value for an error in the motion dimension of each of N pieces of the target objects, wherein said estimation values have been transformed through the second coordinate transformation. ### Claim 10 (depends on 2) The motion state determination apparatus according to claim 2, wherein the processor is further configured to: set respective different motion models for a prediction value for the motion dimension and a prediction value for an error in the motion dimension of each of N sets of the target objects; and calculate the component parallel to the route and the component vertical to the route, wherein N is a predetermined number. ### Claim 11 (depends on 1) The motion state determination apparatus according to claim 1, wherein the processor further configured to: calculate a change in a component parallel to the route in accordance with a time change and a change in a component vertical to the route in accordance with a time change, based on a component parallel to the route and a component vertical to the route of each of an estimation value for the motion dimension of the target object and an estimation value for an error in the motion dimension thereof in the second coordinate system; and determine whether or not the target object is meandering, based on respective changes, in accordance with the time change, in a component vertical to the route of each of an estimation value for the motion dimension of the target object and an estimation value for an error in the motion dimension thereof.