Object positioning method and device

Abstract

To disclose an object positioning method and apparatus.SOLUTION: An object positioning apparatus according to an embodiment is configured to obtain a reference position for positioning an object, obtain a map-based heading angle of the object based on multiple waypoints on a map, and estimate a current position of the object based on the reference position and the map-based heading angle.SELECTED DRAWING: Figure 1

Description

[Technical Field]

[0001] The embodiments relate to a method and apparatus for positioning an object. [Background technology]

[0002] Services based on object location are becoming increasingly common, and errors in estimating object location can significantly affect the content and quality of such services. In autonomous driving systems, vehicle location is used to plan local routes. Furthermore, autonomous driving systems perform dead reckoning using accelerometer and direction sensors, but errors in direction angles can lead to cumulative positioning errors. Accumulating positioning errors in high-speed autonomous vehicles can lead to collisions, lane departures, incorrect route travel, and routing errors. Summary of the Invention [Problem to be solved by the invention]

[0003] An object of the present invention is to provide a method and apparatus for appropriately positioning an object. [Means for solving the problem]

[0004] An object positioning method according to one embodiment includes the steps of obtaining a reference position for positioning an object, obtaining a map direction angle of the object based on a plurality of waypoints on a map, and estimating a current position of the object based on the reference position and the map direction angle.

[0005] According to one embodiment, the map may represent roads using multiple waypoints on a single line.

[0006] According to one embodiment, the step of obtaining the map orientation angle may include the steps of detecting a nearest waypoint from the object based on the last estimated position of the object, and calculating a map orientation angle of the object based on the detected waypoint and a next waypoint of the detected waypoint.

[0007] According to one embodiment, the step of obtaining the map direction angle may include the steps of detecting one of the waypoints based on the last estimated position of the object, and determining the map direction angle corresponding to the detected waypoint as the map direction angle of the object.

[0008] An object positioning method according to one embodiment further includes a step of acquiring the object velocity and direction angle detected from a sensor, and the step of estimating the current position may include a step of generating a second direction angle for dead reckoning based on the map direction angle and the detected direction angle, a step of performing dead reckoning based on the second direction angle and the detected velocity, and a step of estimating the current position of the object based on the results of performing the dead reckoning.

[0009] According to one embodiment, the step of generating the second direction angle may include the steps of comparing the map direction angle with the detected direction angle, and generating the second direction angle based on the comparison result.

[0010] According to one embodiment, the step of generating the second direction angle based on the comparison result may include a step of generating the second direction angle based on the map direction angle if a difference between the map direction angle and the detected direction angle is within a predefined range.

[0011] According to one embodiment, the step of generating the second direction angle based on the comparison result may include the step of generating the second direction angle based on the detected direction angle when a difference between the map direction angle and the detected direction angle deviates from a predefined range.

[0012] According to one embodiment, the step of estimating the current position of the object may include the steps of estimating the current position of the object based on the detected direction angle, and generating lane change information for the object based on the estimated current position.

[0013] According to one embodiment, the step of generating the second direction angle may include a step of correcting the detected direction angle using the map direction angle, and a step of generating the second direction angle based on the correction result.

[0014] According to an embodiment, generating the second direction angle may include applying weights to the map direction angle and the detected direction angle, respectively, to generate the second direction angle.

[0015] According to one embodiment, the step of applying the weighting value to generate the second direction angle may include the step of increasing the weighting value of the map direction angle if the difference between the map direction angle and the detected direction angle is less than a threshold difference.

[0016] According to one embodiment, the sensors may include an accelerometer sensor and a direction sensor.

[0017] According to one embodiment, the step of obtaining the object velocity and direction angle comprises:

[0018] The method may include the steps of acquiring an initial direction angle from a GPS (Global Positioning System) sensor, acquiring a steering wheel rotation angle of the vehicle from a sensor of the vehicle, and calculating a direction angle of the object by applying the steering wheel rotation angle to the initial direction angle.

[0019] According to one embodiment, obtaining the object velocity and direction angle may include obtaining wheel speeds of the vehicle from sensors on the vehicle, and calculating the object velocity based on the wheel speeds.

[0020] According to one embodiment, the step of obtaining the reference position may include the steps of obtaining a current GPS position from a GPS sensor at a predefined period, and updating the reference position using the current GPS position if at least one of a first condition that a difference between the current GPS position and a previous GPS position is greater than a first threshold difference and a second condition that a difference between the current GPS position and the estimated current position is less than a second threshold difference is satisfied.

[0021] According to one embodiment, the plurality of waypoints may be generated based on position information recorded along a lane on a road.

[0022] According to one embodiment, the plurality of waypoints may be generated by converting position information recorded on a lane on a road to represent a single lane.

[0023] An object positioning method according to one embodiment includes the steps of: obtaining a reference position for positioning an object; estimating a current position of the object from the reference position; obtaining a current GPS position of the object from a GPS sensor; and updating the estimated current position in response to the current GPS position being bounced.

[0024] According to one embodiment, the step of updating the current location may include a step of determining that the current GPS location has bounced if at least one of a first condition is satisfied, in which a difference between the previous GPS location of the object and the current GPS location is greater than a first threshold difference, and a second condition is satisfied, in which a difference between the current GPS location and the estimated current location is less than a second threshold difference.

[0025] According to one embodiment, the previous GPS position and the current GPS position may be corrected based on the object velocity and direction.

[0026] According to one embodiment, updating the current location may include updating the estimated current location to the current GPS location in response to the current GPS location being bounced.

[0027] According to one embodiment, the current GPS position may be corrected based on the object velocity and direction.

[0028] An object positioning device according to one embodiment includes a sensor for acquiring the position of an object, a memory storing instructions and a plurality of waypoints generated based on position information recorded along a lane on a road, and a processor for executing the instructions, wherein the instructions perform the steps of acquiring a reference position based on the position, detecting the waypoint closest to the object from among the waypoints, calculating a map direction angle of the object based on the detected waypoint and the next waypoint after the detected waypoint, and determining the current position of the object based on the reference position and the map direction angle.

[0029] According to one embodiment, the memory may store map direction angles corresponding to the detected waypoints.

[0030] According to one embodiment, the processor may detect the next waypoint based on a perceived orientation of the object. [Effects of the Invention]

[0031] According to the present invention, a method and apparatus for locating an object can be provided. [Brief explanation of the drawings]

[0032] [Figure 1] 1 is a flowchart illustrating an object positioning method according to an embodiment. [Figure 2] 1 is a conceptual diagram illustrating an object positioning method according to an embodiment; [Figure 3] 10A and 10B are diagrams for explaining a map direction angle acquisition operation according to an embodiment; [Figure 4] 10A and 10B are diagrams illustrating an operation of comparing a map direction angle with a direction angle detected by a sensor according to an embodiment; [Figure 5A] 1 is a flowchart illustrating an object positioning method according to an embodiment. [Figure 5B] 1 is a flowchart illustrating an object positioning method according to an embodiment. [Figure 6] 1 is a flowchart illustrating an object positioning method according to an embodiment. [Figure 7] 10A and 10B are diagrams for explaining a map direction angle acquisition operation according to an embodiment; [Figure 8] 10A and 10B are diagrams illustrating an operation of performing positioning using a map direction angle according to an embodiment. [Figure 9] 1 is an exemplary diagram of an object positioning device according to an embodiment; DETAILED DESCRIPTION OF THE INVENTION

[0033] The specific structural or functional descriptions of the embodiments are disclosed for illustrative purposes only and may be modified in various forms. Therefore, the embodiments are not limited to the specific disclosed forms, and the scope of the present specification includes modifications, equivalents, or alternatives within the technical spirit.

[0034] Although terms such as "first" or "second" may be used to describe multiple components, such terms should be construed only to distinguish one component from the other components. For example, a first component may be designated as a second component, and similarly, a second component may be designated as a first component.

[0035] The singular expression includes the plural expression unless the context clearly dictates otherwise. In this specification, the words "comprise" or "have" and the like indicate the presence of a feature, number, step, operation, component, part, or combination thereof described in the specification, and should be understood as not precluding the possibility of the presence or addition of one or more other features, numbers, steps, operations, components, parts, or combinations thereof.

[0036] Unless otherwise defined, all terms used herein, including technical or scientific terms, have the same meaning as commonly understood by a person of ordinary skill in the art to which the present invention pertains. Commonly used predefined terms should be interpreted as having a meaning consistent with the meaning they have in the context of the relevant art, and should not be interpreted as having an ideal or overly formal meaning unless expressly defined herein.

[0037] Hereinafter, embodiments will be described in detail with reference to the accompanying drawings, in which the same reference numerals in the various drawings denote the same elements.

[0038] An object positioning device according to one embodiment performs positioning of an object using a direction angle estimated from a map. The object positioning device may compensate for accuracy errors in a direction angle measured from a sensor by estimating the direction angle of an object from patterns or road characteristics included in a map. The object positioning device may perform accurate positioning using a global positioning system (GPS) and dead reckoning in a low-precision map environment. The positioning method using the object positioning device is applicable not only to autonomous driving systems but also to all technical fields requiring positioning.

[0039] An object positioning device according to an embodiment may be implemented as a device for estimating the position of an object, for example, as a software module, a hardware module, or a combination thereof. The object positioning device generates or processes operations, calculations, and instructions related to object positioning. Objects to be positioned include not only vehicles traveling on roads, but also people, smartphones, tablet computers, wearable devices, and the like. Vehicles according to an embodiment may include automobiles, trucks, tractors, scooters, motorcycles, cycles, amphibious vehicles, snowmobiles, boats, public transportation vehicles, buses, monorails, electric vehicles (EVs), and drones.

[0040] The object positioning device may be implemented as a server that is installed in various computing devices and / or systems, such as a vehicle, a smartphone, a tablet computer, a wearable device, an IoT device, etc., and communicates with the terminal. For example, the object positioning device may be applied to a robot that requires positioning operations. Alternatively, the object positioning device may acquire positioning information from a pre-established database, and the database may be implemented as a memory included in the object positioning device or as an external device, such as a server, that can be connected to the object positioning device via a wired, wireless, or network connection.

[0041] Hereinafter, the overall contents of an object positioning method according to an embodiment will be described with reference to Figures 1 and 2. An operation of acquiring a map direction angle according to an embodiment will be described with reference to Figure 3. An operation of comparing a map direction angle with a direction angle detected from a sensor according to an embodiment will be described with reference to Figure 4. An object positioning method according to an embodiment will be described with reference to Figures 5A to 6. An operation of acquiring a map direction angle according to an embodiment will be described with reference to Figure 7. Utilization of the map direction angle according to an embodiment will be described with reference to Figure 8. A configuration of an apparatus according to an embodiment will be described with reference to Figure 9.

[0042] FIG. 1 is a flowchart illustrating an object positioning method according to an embodiment, and FIG. 2 is a conceptual diagram illustrating an object positioning method according to an embodiment. The operations illustrated in FIG. 1 may be performed in the order and manner shown, but the order of some operations may be changed or some operations may be omitted without departing from the spirit and scope of the illustrated embodiment. Multiple operations illustrated in FIG. 1 may be performed substantially in parallel or simultaneously. One or more blocks and combinations of blocks illustrated in FIG. 1 may be implemented by a special-purpose hardware-based computer performing a specific function, or a combination of special-purpose hardware and computer instructions.

[0043] According to one embodiment, the object positioning device acquires a reference position 201 for positioning the object (S101). The reference position 201 is a position that serves as a reference for positioning the object, and the object positioning device can estimate the position of the object using the reference position 201.

[0044] According to one embodiment, the object positioning device obtains a reference position 201 based on the last estimated position of the object. The object positioning device repeatedly performs positioning for the object and determines the most recently estimated position as the reference position 201 for estimating the current position 205. The object positioning device performs positioning based on the reference position 201, and repeatedly performs positioning based on the estimated position according to the positioning result.

[0045] According to one embodiment, the object positioning device uses a GPS sensor to acquire the reference position 201. The object positioning device acquires position information from the GPS sensor mounted on the object at a predefined period, and updates the reference position 201 using the information acquired from the GPS sensor. If the current GPS position satisfies certain conditions, the object positioning device may update the reference position 201 using the current GPS position.

[0046] The frequency of bounces and the accuracy of the GPS position may vary depending on the performance of the GPS sensor. As will be described later, bounces generally refer to updating the reference position in object positioning. The object positioning device may apply a bias to the bounced GPS position to set the reference position 201. The object positioning device monitors whether the GPS position has bounced in order to set the reference position 201. Although an embodiment in which the reference position 201 is set based on the bounced GPS position is described, various methods may be used for the object positioning device to acquire the reference position 201. Embodiments relating to determining whether the GPS position has bounced, updating the reference position 201, and initializing the position will be described later with reference to FIG. 5B.

[0047] According to one embodiment, the object positioning device acquires a map direction angle 202 of the object based on a plurality of waypoints on a map (S102). Waypoints are points set at specific locations on a map, and elements that make up a map, such as roads, addresses, landforms, structures, and landmarks, are represented by at least one waypoint. The map represents roads using a plurality of waypoints on a single line.

[0048] A plurality of waypoints on a single line are generated based on position information recorded along one roadway or lane (hereinafter referred to as one roadway) on a road and stored in a database. For example, position information is recorded from a vehicle traveling along one roadway on a road, a plurality of waypoints are generated based on the recorded position information, and a map is constructed or updated via the generated waypoints.

[0049] The multiple waypoints on a single line are generated by converting position information recorded on a lane on a road to represent a single lane and storing it in a database. For example, multiple vehicles travel on a roadway on a map, and position information is recorded from the vehicles. Because the vehicle position information is scattered across multiple lane, the position information recorded on the lane may be converted into a representative value or converted to represent a single lane through statistical smoothing. The position information used to represent a road as multiple waypoints on a single line may be collected and recorded from a vehicle or a terminal in the cloud. The method of representing a road in a map using multiple waypoints on a single line is not limited to the above-mentioned method, and new multiple waypoints may be constructed, or various methods using existing waypoints may be adopted.

[0050] The object positioning device acquires a map representing a road using multiple points on a single line from an internal or external memory or a server, and acquires a map direction angle 202 of the object based on the waypoints on the acquired map. The map direction angle 202 is acquired as the direction angle of the object acquired based on the map, and the specific contents will be described later with reference to FIG. 3.

[0051] The object positioning device estimates the current position 205 of the object based on the reference position 201 and the map direction angle 202 (S103). The object positioning device performs dead reckoning to estimate the current position 205. Dead reckoning is a method of applying the object velocity 204 and direction angle to the reference position 201 to estimate the current position 205 of the object. The object positioning device performs dead reckoning based on the map direction angle 202 to estimate the current position 205.

[0052] The object positioning device acquires the detected object velocity 204 and direction angle 203 from the sensors. According to one embodiment, the object positioning device acquires the object velocity 204 from an accelerometer sensor and acquires the object direction angle 203 from a direction angle sensor. The object positioning device generates either the object velocity 204 or the direction angle 203 from an IMU (Inertial Measurement Unit) sensor.

[0053] The object positioning device generates a second direction angle based on the map direction angle 202 and the direction angle 203 detected by the sensor. The second direction angle is a direction angle applied when performing dead reckoning. According to one embodiment, the object positioning device compares the map direction angle 202 with the direction angle 203 detected by the sensor, and generates the second direction angle based on the comparison result.

[0054] The object positioning device generates a second direction angle based on the map direction angle 202 if the difference between the map direction angle 202 and the direction angle 203 detected by the sensor is within a predefined range. For example, if the difference between the map direction angle 202 and the direction angle 203 detected by the sensor is smaller than a threshold angle, the object positioning device may apply the map direction angle 202 to dead reckoning to estimate the current position 205. The map direction angle 202 and the direction angle 203 detected by the sensor may calculate an angle based on a predefined line 206.

[0055] If the difference between the map direction angle 202 and the direction angle 203 detected by the sensor deviates from a predefined range, the object positioning device generates a second direction angle based on the direction angle 203 detected by the sensor. For example, if the difference between the map direction angle 202 and the direction angle 203 detected by the sensor is greater than a threshold angle, the object positioning device may apply the direction angle 203 detected by the sensor to dead reckoning to estimate the current position 205.

[0056] As a different method for generating the second direction angle, the object positioning device corrects the direction angle 203 detected by the sensor using the map direction angle 202 to generate the second direction angle. If the map direction angle 202 is larger than the direction angle 203 detected by the sensor, the object positioning device corrects the direction angle 203 detected by the sensor so that the magnitude is larger, thereby generating the second direction angle. In the same manner, if the map direction angle 202 is smaller than the direction angle 203 detected by the sensor, the object positioning device corrects the direction angle 203 detected by the sensor so that the magnitude is smaller, thereby generating the second direction angle. The degree to which the object positioning device corrects the direction angle 203 detected by the sensor with the map direction angle 202 may be determined taking into consideration design intent, sensor performance, system settings, performance, and / or efficiency. For example, the correction method may be set taking into consideration statistical records regarding the accuracy and error of the map direction angle 202 and the direction angle 203 detected by the sensor.

[0057] As another method for generating the second direction angle, the object positioning device may generate a second direction angle by applying a weight to each of the map direction angle 202 and the direction angle 203 detected by the sensor, and apply the generated second direction angle to dead reckoning. The weight is set to a value that differs depending on the difference between the map direction angle 202 and the direction angle 203 detected by the sensor. For example, the object positioning device may set the weight of the direction angle 203 detected by the sensor to be greater than the weight of the map direction angle 202 as the difference between the map direction angle 202 and the direction angle 203 detected by the sensor increases, and may set the weight of the direction angle 203 detected by the sensor to be smaller than the weight of the map direction angle 202 as the difference between the map direction angle 202 and the direction angle 203 detected by the sensor decreases. The weight is determined taking into consideration design intent, sensor performance, system settings, performance, and / or efficiency, and various methods may be adopted and applied to embodiments in which the weight is set.

[0058] 2, the object positioning device generates a second direction angle by correcting a direction angle 203 detected by a sensor to a map direction angle 202. The object positioning device performs dead reckoning based on the map direction angle 202 and the object velocity 204, and estimates a current position 205 of the object based on the results of the dead reckoning. The object positioning device applies the map direction angle 202 to the dead reckoning using Equation (1).

[0059]

number

[0060] The object positioning device performs dead reckoning using equation (2).

[0061]

number

[0062] 3 is a diagram illustrating an operation for acquiring a map direction angle according to an embodiment. Referring to FIG. 3, a road 307 is represented as a plurality of points on a single line, and the map includes the road. The object positioning device acquires the map on which the road 307 is represented by a plurality of waypoints on the map, and acquires a map direction angle 303 of the object 301 using the waypoints.

[0063] According to one embodiment, the object positioning device detects the closest waypoint 304 from the object 301 based on the last estimated position of the object 301. The object positioning device calculates the map direction angle 303 of the object 301 based on the detected waypoint 304 and its next waypoint 305. The object positioning device calculates the map direction angle 303 of the object 301 based on the direction angle 306 connecting the waypoint 304 and the waypoint 305. The object positioning device can recognize the direction in which the object 301 is traveling and detect the next waypoint 305 of the waypoint 304 based on the recognized direction. Referring to FIG. 3 , the object 301 traveling on the road 307 on the map is traveling from south to north, so the object positioning device detects the next waypoint 305 north of the waypoint 304.

[0064] The map direction angle corresponding to the waypoint may be calculated and stored in advance. In this case, the direction angle 306 corresponding to the last estimated waypoint 304 of the object 301 is determined as the map direction angle 303 of the object 301. The map direction angle of the waypoint along the traveling or moving direction may be predefined and stored in the map, and the object positioning device may select one of the waypoints based on the position of the object 301 to obtain the map direction angle 303 of the object 301.

[0065] The object positioning device generates a second direction angle for dead reckoning using a map direction angle 303 acquired based on a waypoint representing a road 307 and a direction angle 302 detected from a sensor. The above-described content is applied to the operation of generating the second direction angle.

[0066] FIG. 4 is a diagram for explaining an operation of comparing a map direction angle with a direction angle detected by a sensor according to an embodiment.

[0067] 4, the object 401 may be a vehicle. The object positioning device determines whether the object 401 is changing lanes based on a map direction angle 402 of the object 401 and a direction angle 403 detected by a sensor.

[0068] The object positioning device compares the map direction angle 402 with the direction angle 403 detected from the sensor, and if the difference is outside a predefined range, performs positioning of the object 401 using the direction angle 403 detected from the sensor. For example, the object positioning device applies the direction angle 403 detected from the sensor to dead reckoning and determines whether the object 401 has changed lanes based on the position of the object 401 estimated by dead reckoning. As shown in FIG. 4, the object positioning device determines the direction angle 403 detected from the sensor as the direction angle for positioning and performs dead reckoning to determine that the road of the object 401 has changed from lane 1 to lane 2. Additionally, lane change information of the object positioning device is displayed on the display of the object 401. For example, if a navigation service is provided from a terminal mounted on the object 401, the object positioning device transmits lane change information to the terminal, and the lane change information is displayed on the display of the terminal mounted on the object 401. For example, if an autonomous driving system is used, the lane change information is provided to the autonomous driving system of the object 401. As a different example, lane change information may be transmitted to a server or other vehicles near the object 401 to smoothly manage traffic and prevent collisions.

[0069] FIG. 5A is a flowchart illustrating an object positioning method according to an embodiment. The operations illustrated in FIG. 5 may be performed in the order and manner shown, although the order of some operations may be changed or some operations may be omitted without departing from the spirit and scope of the illustrated embodiment. Multiple operations illustrated in FIG. 5 may be performed substantially in parallel or simultaneously. One or more blocks and combinations of blocks illustrated in FIG. 5 may be implemented by a special-purpose hardware-based computer performing a specific function, or by a combination of special-purpose hardware and computer instructions. The descriptions of FIGS. 1 to 4 are also applicable to FIG. 5A, and therefore, redundant descriptions will be omitted.

[0070] 5A, the object positioning device performs dead reckoning using information detected from a GPS sensor 501, an accelerometer sensor 502, and a direction sensor 503, and information acquired from a map 504. The object positioning device compares the direction angle detected from the direction sensor 503 with the map direction angle generated from the map 504 (S505). If the object positioning device determines that the direction angle detected from the direction sensor 503 and the map direction angle generated from the map 504 are similar to each other based on a predefined criterion, the object positioning device uses the map direction angle generated from the map 504 in performing dead reckoning (S506). If the object positioning device determines that the direction angle detected from the direction sensor 503 and the map direction angle generated from the map 504 are not similar to each other based on a predefined criterion, the object positioning device uses the direction angle detected from the direction sensor 503 in performing dead reckoning (S507).

[0071] The object positioning device determines whether the GPS position has bounced (S508) using the position information acquired from the GPS sensor 501. The details of determining whether the GPS position has bounced will be described with reference to FIG. 5B.

[0072] Referring to FIG. 5B, the object positioning device uses a GPS sensor to determine the time when t=t 0、 t 1、 The GPS position (i.e., GPS0, GPS1, GPS2, GPS3, and GPS4) is acquired at each time point t2, t3, and t4. The object positioning device performs positioning for the object, and at t=t 0、 t 1、 At times t2, t3 and t4, the positions P0, P1, P2, P3 and P4 of the object can be estimated, respectively.

[0073] 5B, the measurement period of the GPS sensor is longer than the positioning period of the object positioning device. As the performance of the GPS sensor improves, the measurement period of the GPS sensor can become shorter. However, except for high-cost, high-spec GPS sensors, the measurement period of most GPS sensors is longer than the positioning period of the object positioning device. The object positioning device can improve the accuracy of positioning based on the azimuth sensor by utilizing a low-cost GPS sensor and determining whether the GPS position bounces.

[0074] The object positioning device determines the time t between t0 and t1. 0,1 , t 0,2 and t 0,3 The object positioning is performed by 0,1 , P 0,2 and P 0,3 The object positioning device estimates the time t=t between t1 and t2. 1,1 , t 1,2 and t 1,3 The object positioning is performed by 1,1 , P 1,2 and P 1,3 The object positioning device estimates the time between t2 and t3 at t=t 2,1 , t 2,2 and t 2,3 The object positioning is performed by 2,1 , P 2,2 and P 2,3 The object positioning device estimates the time between t3 and t4 at t=t 3,1 , t 3,2 and t 3,3 The object positioning is performed by 3,1 , P 3,2 and P 3,3 are estimated respectively.

[0075] 5B, the object positioning device may initialize the object's position P0 as the GPS position GPS0 at time t=t0. 0,1Perform dead reckoning from P0 at time point and find the object's position P 0,1 The object positioning device estimates the time t=t 0,2 At this point, P 0,1 Perform dead reckoning from the object's position P 0,2 In this way, the object positioning device can repeatedly perform object positioning.

[0076] The GPS position may differ from the position estimated by the object positioning device. The position of an object estimated by dead reckoning is often further along the traveling direction than the GPS position. Referring to FIG. 5B, GPS1 and P1 indicate different positions despite being at the same time. Similarly, GPS2 and P2 indicate different positions, and GPS3 and P3 also indicate different positions. Therefore, the object positioning device can determine whether the GPS position has bounced and, depending on the determination result, initialize the current position of the object to the GPS position. An embodiment in which whether or not there has been a bounce at time t=t4 will be described.

[0077] According to one embodiment, the object positioning device determines whether the difference between the previous GPS position and the current GPS position is greater than a threshold difference. Referring to Figure 5B, the object positioning device determines whether condition 1 is met at time t=t4, where the difference between the previous GPS position GPS3 and the current GPS position GPS4 is greater than a threshold difference. If condition 1 is met, the object positioning device determines that the current GPS position GPS4 has bounced.

[0078] According to another embodiment, the object positioning device determines whether the difference between the current position of the object and the current GPS position is smaller than a threshold difference. Referring to Figure 5B, the object positioning device performs positioning on the object at time t = t4 to estimate P4, and determines whether condition 2 is met, that is, the difference between the object's current position P4 and the current GPS position GPS4 is smaller than a threshold difference. If condition 2 is met, the object positioning device determines that the current GPS position GPS4 has bounced.

[0079] According to a further embodiment, the object positioning device determines that the GPS position is bounced if both Condition 1 and Condition 2 are satisfied. Referring to FIG. 5B, the object positioning device determines that the GPS position is bounced if the previous GPS position GPS at time t=t4 is satisfied. 3、 It is determined whether conditions 1 and 2 are both met based on the current GPS position GPS4 and the current position P4 of the object.

[0080] According to one embodiment, the object positioning device calculates a GPS position GPS corresponding to a time t. t Corrected GPS t The object positioning device determines whether at least one of the above conditions 1 and 2 is satisfied by using the above. t GPS corrected t The GPS position measured by the GPS sensor may have a delay in the information itself. Therefore, the object positioning device initializes the GPS position to DR, which is an empirical value that takes delay into account. t GPS t In harmony with GPS t GPS t +DR t can be corrected to

[0081] According to one embodiment, the object positioning device calculates the DR based on the object velocity and direction. t GPS t indicates the position, and DR t GPS t The object positioning device calculates the DR based on the object velocity. t Scale the magnitude component of the DR based on the object's orientation. t For example, the object positioning device sets the directional component of DR as the object velocity increases. t The object positioning device may significantly scale the size components of the vector DR, which is created by taking into account the object velocity and direction. tUsing GPS t can be corrected.

[0082] Referring to Figure 5B, the object positioning device corrects the previous GPS position GPS3 and the current GPS position GPS4 to GPS3+DR3 and GPS4+DR4, respectively, at time t=t4, and determines whether conditions 1 and 2 are met based on GPS3+DR3, GPS4+DR4, and P4. If it is determined that the corrected current GPS position GPS4+DR4 has bounced, the object positioning device initializes P4 to GPS4+DR4. 4,1 At this point, the object positioning device is initialized and can perform object positioning from P4.

[0083] 5A again, if the object positioning device determines that the GPS position has bounced, it sets the bounced GPS position as the reference position in the execution of dead reckoning (S509). If the object positioning device determines that the GPS position has not bounced, it uses the previously set reference position without updating the reference position in the execution of dead reckoning (S510).

[0084] The object positioning device performs dead reckoning using the reference position and the speed and direction angle detected by the accelerometer sensor 502 (S511), and estimates the position of the object based on the dead reckoning results (S512). The object positioning device updates the information included in the map 504 using the estimated object position. According to one embodiment, the object positioning device updates the object's position on the map to detect waypoints close to the object.

[0085] The object positioning device can perform subsequent positioning based on the estimated object position, and can repeat the positioning at a predefined period.

[0086] FIG. 6 is a flowchart illustrating an object positioning method according to an embodiment. The operations illustrated in FIG. 6 may be performed in the order and manner shown, but the order of some operations may be changed or some operations may be omitted without departing from the spirit and scope of the illustrated embodiment. Multiple operations illustrated in FIG. 6 may be performed substantially in parallel or simultaneously. One or more blocks and combinations of blocks illustrated in FIG. 6 may be implemented by a special-purpose hardware-based computer performing a specific function, or by a combination of special-purpose hardware and computer instructions. The descriptions of FIGS. 1 through 5B are also applicable to FIG. 6, and therefore, redundant descriptions will be omitted.

[0087] 6, the object positioning device generates an object velocity and direction angle using information obtained from an IMU sensor 601. The object may be a vehicle.

[0088] The object positioning device acquires the wheel speed of the vehicle from the vehicle's IMU sensor 601. The object positioning device calculates the vehicle's speed based on the wheel speed (S602). According to one embodiment, the object positioning device calculates the vehicle's speed using an average of the vehicle's wheel speeds. The object positioning device calculates the vehicle's speed using Equation (3).

[0089] s=(s fl +s fr +s rl +s rr ) / 4 (3)

[0090] s is the average wheel speed, and s fl ,s fr ,s rl ,s rr are the wheel speeds of the front left, front right, rear left, and rear right wheels, respectively.

[0091] The object positioning device determines an initial direction angle based on information acquired from a GPS sensor. The object positioning device determines the initial direction angle from multiple position values ​​acquired from the GPS sensor, and may determine the initial direction angle by, for example, calculating direction information from a previous GPS position to a current GPS position.

[0092] The object positioning device acquires the steering wheel rotation angle of the vehicle from the vehicle's IMU sensor 601. The object positioning device calculates the vehicle's direction angle by applying the steering wheel rotation angle to the initial direction angle (S603). According to one embodiment, the object positioning device calculates the vehicle's direction angle by repeatedly accumulating the steering wheel rotation angle with the initial direction angle. The object positioning device calculates the vehicle's direction angle using Equation (4).

[0093] θ t =θ0+Σ t Δθ t (4)

[0094] θ t is the direction angle of the vehicle at time t, θ is the initial direction angle, and Δθ is the steering wheel rotation angle. Σ t Δθ t is the cumulative sum of the steering wheel rotation angle up to time t.

[0095] The object positioning device may calculate the vehicle speed and the vehicle direction angle using the vehicle's internal sensors even if the object positioning device does not have an accelerometer sensor and a direction sensor. The operation of performing dead reckoning using the vehicle speed, the vehicle direction angle, and the map direction angle is as described above.

[0096] 7 is a diagram illustrating a map direction angle acquisition operation according to an embodiment. Referring to FIG. 7, the object positioning device acquires a map direction angle 704 of an object 702 based on a map 701 representing the curvature of a road 703. The object positioning device acquires the curvature of the road 703 from the map 701 based on the last positioned position of the object 702. The object positioning device acquires the map direction angle 704 of the object 702 based on the acquired curvature. As described above, the object positioning device can estimate the current position of the object 702 using the map direction angle 704 and a reference position 705.

[0097] The curvature of the road 703 for obtaining the map direction angle 704 is mapped to a position on the map 701. For example, the curvature of the road for each section on the map 701 is set in advance and stored in a database.

[0098] FIG. 8 is a diagram for explaining an operation of performing positioning using a map direction angle according to one embodiment.

[0099] The object positioning device can perform good positioning of the vehicle 801 even when the vehicle 801 is traveling through a tunnel 812. The tunnel 812 is an environment where it is difficult to receive a GPS position, so the accuracy of positioning using the GPS position may decrease.

[0100] The object positioning device performs positioning using the map direction angle 811 of the vehicle 801 and determines the last estimated position 803 before entering the tunnel 812 as the reference position. The object positioning device may generate the map direction angle 811 of the vehicle 801 that has entered the tunnel 812 using a map that represents the curvature of the road of the tunnel 812 or a map that represents the road of the tunnel 812 as multiple waypoints. The object positioning device performs dead reckoning using the reference position 803 and the map direction angle 811 of the vehicle 801 in the tunnel 812, and can estimate the position of the vehicle 801 as a result of the dead reckoning. Therefore, the object positioning device can perform accurate positioning by generating the map direction angle 811 of the object using a map even in an environment where it is difficult to receive or acquire a GPS position.

[0101] 9 is an exemplary diagram of an object positioning device according to an embodiment. Referring to FIG. 9, the object positioning device 901 includes a processor 902 and a memory 903. The object positioning device 901 may be mounted on a vehicle or a terminal, or may be installed outside the vehicle or terminal to communicate with the vehicle or terminal.

[0102] The memory 903 stores a program for processing instructions related to object positioning and stores instructions for performing the operations described with reference to Figures 1 to 8. The memory 903 also stores information detected by sensors or cameras and information received from the server. The sensors include a direction sensor, an accelerometer sensor, a gyro sensor, an IMU sensor, radar, LiDAR, GPS, and other sensors.

[0103] The processor 902 loads and executes a program recorded in the memory 903. The processor 902 measures the position of the object, displays the positioning result on a display, and, if the object is a vehicle, controls the traveling of the vehicle using the positioning result. Here, the operation of the processor 902 is the same as that of the embodiment described above, and therefore a description of the overlapping content will be omitted.

[0104] The display 904 may be a physical structure including one or more hardware components that provide the capability to render a user interface and receive user input. For example, the display 904 may be built into the object positioning device 901. For example, the display 904 may be an external peripheral device that is detachable from the object positioning device 901. The display 904 may be a single-screen or multi-screen display. The processor 902 may use a head-up display (HUD) to project objects and their directions onto the windshield or a separate screen in the vehicle. The display of objects is not limited to the above example; other vehicle instrument panels, vehicle infotainment systems, screens, or vehicle display panels may perform the display function. Other displays, such as smart displays and eyeglass displays (EGDs) operably connected to the object positioning device 901, may also be used.

[0105] The above-described embodiments may be implemented using hardware components, software components, or a combination of hardware and software components. For example, the devices and components described herein may be implemented using one or more general-purpose or special-purpose computers, such as a processor, controller, arithmetic logic unit (ALU), digital signal processor, microcomputer, field programmable array (FPA), programmable logic unit (PLU), microprocessor, or other device that executes and responds to instructions. The processing device executes an operating system (OS) and one or more software applications that run on the operating system. The processing device also accesses, stores, manipulates, processes, and generates data in response to the execution of the software. For ease of understanding, a single processing device may be described; however, those skilled in the art will recognize that a processing device may include multiple processing elements and / or multiple types of processing elements. For example, a processing device may include multiple processors or one processor and one controller. Other processing configurations, such as parallel processors, are also possible.

[0106] Software includes computer programs, codes, instructions, or a combination of one or more of these, which configure a processing device to operate as desired and independently or jointly instruct the processing device. The software and / or data may be interpreted by a processing device and embodied permanently or temporarily in any type of machine, component, physical device, virtual device, computer storage medium or device, or transmitted signal wave to provide instructions or data to the processing device. The software may be distributed across computer systems coupled to a network and stored or executed in a distributed manner. The software and data may be stored on one or more computer-readable recording media.

[0107] The methods according to the present invention may be embodied in the form of program instructions that can be executed by various computer means and stored on a computer-readable storage medium. The storage medium may include program instructions, data files, data structures, and the like, alone or in combination. The storage medium and program instructions may be specially designed and constructed for the purposes of the present invention, or they may be well-known and available to those skilled in the art of computer software. Examples of computer-readable storage media include magnetic media such as hard disks, floppy disks, and magnetic tape, optical media such as CD-ROMs and DVDs, magneto-optical media such as floptical disks, and hardware devices specially configured to store and execute program instructions, such as ROM, RAM, and flash memory. Examples of program instructions include not only machine code, such as produced by a compiler, but also high-level language code executed by a computer using an interpreter, for example. A hardware device may be configured to operate as one or more software modules to perform the operations described in the present invention, or vice versa.

[0108] Although the embodiments have been described above with reference to limited drawings, those skilled in the art may apply various technical modifications and variations based on the above description. For example, the described techniques may be performed in a different order than described, and / or the components of the described systems, structures, devices, circuits, etc. may be combined or combined in a different manner than described, or may be replaced or substituted with other components or equivalents, and still achieve suitable results.

[0109] Therefore, the scope of the present invention should not be limited to the disclosed embodiments, but should be determined by the appended claims and their equivalents.

[0110] <Additional Notes> (Appendix 1) obtaining a reference position for positioning the object; obtaining a map orientation angle of the object based on a plurality of waypoints on a map; estimating a current position of the object based on the reference position and the map direction angle; An object positioning method comprising: (Appendix 2) 2. The object positioning method of claim 1, wherein the map represents roads using multiple waypoints on a single line. (Appendix 3) The step of acquiring a map direction angle includes: Detecting the nearest waypoint from the object based on the last estimated position of the object; calculating a map orientation angle of the object based on the detected waypoint and a waypoint subsequent to the detected waypoint; 2. The object positioning method of claim 1, comprising: (Appendix 4) The step of acquiring a map direction angle includes: Detecting one of the waypoints based on the last estimated position of the object; determining a map orientation angle corresponding to the detected waypoint as a map orientation angle of the object; 2. The object positioning method of claim 1, comprising: (Appendix 5) The method further includes acquiring the detected object velocity and direction angle from a sensor; The step of estimating the current location includes: generating a second direction angle for dead reckoning based on the map direction angle and the detected direction angle; performing dead reckoning based on the second direction angle and the detected velocity; estimating a current position of the object based on a result of the dead reckoning; 5. An object positioning method according to any one of claims 1 to 4, comprising: (Appendix 6) The step of generating the second direction angle includes: comparing the map direction angle with the detected direction angle; generating a second direction angle based on the comparison result; 6. The object positioning method of claim 5, comprising: (Appendix 7) An object positioning method as described in Appendix 6, wherein the step of generating the second direction angle based on the comparison result includes a step of generating the second direction angle based on the map direction angle if a difference between the map direction angle and the detected direction angle is within a predefined range. (Appendix 8) The object positioning method of claim 6, wherein the step of generating the second direction angle based on the comparison result includes a step of generating the second direction angle based on the detected direction angle when a difference between the map direction angle and the detected direction angle deviates from a predefined range. (Appendix 9) the object is a vehicle, The step of estimating the current position of the object includes: estimating a current position of the object based on the detected direction angle; generating lane change information for the object based on the estimated current position; 9. The object positioning method of claim 8, comprising: (Appendix 10) The step of generating the second direction angle includes: correcting the detected direction angle using the map direction angle; generating a second direction angle based on the correction result; 6. The object positioning method of claim 5, comprising: (Appendix 11) An object positioning method as described in Appendix 5, wherein the step of generating the second direction angle includes a step of applying weighting values ​​to the map direction angle and the detected direction angle, respectively, to generate the second direction angle. (Appendix 12) 12. The object positioning method of claim 11, wherein the step of applying a weighting value to generate a second direction angle includes a step of increasing a weighting value of the map direction angle if a difference between the map direction angle and the detected direction angle is less than a threshold difference. (Appendix 13) 6. The object positioning method of claim 5, wherein the sensors include an accelerometer sensor and a direction sensor. (Appendix 14) the object is a vehicle, The step of obtaining the object velocity and direction angle includes: acquiring an initial direction angle by a GPS sensor; acquiring a steering wheel rotation angle of the vehicle from a sensor of the vehicle; calculating a direction angle of the object by applying the handle rotation angle to the initial direction angle; 6. The object positioning method of claim 5, comprising: (Appendix 15) the object is a vehicle, The step of obtaining the object velocity and direction angle includes: obtaining wheel speeds of the vehicle from sensors of the vehicle; calculating the object velocity based on the wheel velocity; 6. The object positioning method of claim 5, comprising: (Appendix 16) The step of acquiring the reference position includes: acquiring a current GPS position from a GPS sensor at a predefined interval; 16. The object positioning method of claim 1, further comprising: updating the reference position using the current GPS position when at least one of a first condition, in which a difference between the current GPS position and a previous GPS position is greater than a first threshold difference, and a second condition, in which a difference between the current GPS position and the estimated current position is less than a second threshold difference, is satisfied. (Appendix 17) 17. The object positioning method according to any one of claims 1 to 16, wherein the plurality of waypoints are generated based on position information recorded along a lane on a road. (Appendix 18) 17. An object positioning method according to any one of claims 1 to 16, wherein the plurality of waypoints are generated by converting position information recorded on lanes on a road to represent a single lane. (Appendix 19) obtaining a reference position for positioning the object; estimating a current position of the object from the reference position; obtaining a current GPS position of the object from a GPS sensor; updating the estimated current location in response to the current GPS location being bounced; An object positioning method comprising: (Appendix 20) 20. The object positioning method of claim 19, wherein the step of updating the current position includes a step of determining that the current GPS position has bounced if at least one of a first condition is satisfied: a difference between the previous GPS position of the object and the current GPS position is greater than a first threshold difference; and a second condition is satisfied: a difference between the current GPS position and the estimated current position is less than a second threshold difference. (Appendix 21) 21. The object positioning method of claim 20, wherein the previous GPS position and the current GPS position are corrected based on the object speed and direction. (Appendix 22) 20. The object positioning method of claim 19, wherein updating the current location comprises updating the estimated current location to the current GPS location in response to the current GPS location being bounced. (Appendix 23) 23. The object positioning method of claim 22, wherein the current GPS position is corrected based on the object speed and direction. (Appendix 24) A computer program that causes a computer of an object positioning device to execute the object positioning method according to any one of Supplementary Notes 1 to 23. (Appendix 25) a sensor for acquiring the position of an object; a memory storing a plurality of waypoints generated based on the instructions and recorded position information along a lane of a road; a processor for executing said instructions; The instruction: obtaining a reference position based on the position; detecting one of the waypoints that is closest to the object; calculating a map orientation angle of the object based on the detected waypoint and a waypoint subsequent to the detected waypoint; determining a current position of the object based on the reference position and the map direction angle; Object positioning device. (Appendix 26) 26. The object positioning device of claim 25, wherein the memory stores a map direction angle corresponding to the detected waypoint. (Appendix 27) 27. The object positioning device of claim 25 or 26, wherein the processor detects the next waypoint based on a recognized direction of the object.

Claims

1. 1. An object positioning method, comprising: obtaining a reference position of the object; obtaining a map orientation angle of the object based on a plurality of waypoints on a map; Using at least one sensor, acquiring a velocity of the object and a sensor-detected direction angle detected by the sensor; generating a second direction angle, comparing the map direction angle with the sensor detected direction angle to determine a difference between the map direction angle and the sensor detected direction angle, and generating the second direction angle based on both the map direction angle to which a first weight value has been applied and the sensor detected direction angle to which a second weight value has been applied, wherein the first weight value is greater than the second weight value when the difference between the map direction angle and the sensor detected direction angle is less than a threshold angle, and the first weight value is less than the second weight value when the difference between the map direction angle and the sensor detected direction angle is greater than the threshold angle; performing dead reckoning based on the reference position, the second direction angle, and the velocity; estimating a current position of the object based on the result of the dead reckoning; the object is a vehicle, and the step of estimating a current position of the object includes a step of generating lane change information for the object based on the estimated current position of the object, and the lane change information for the object is displayed on a display of an autonomous driving system of the vehicle and transmitted to a server or another vehicle; The step of acquiring the reference position includes: acquiring a current GPS position from a GPS sensor at a predefined interval; 1. An object positioning method, comprising: updating the reference position using the current GPS position when both a first condition, in which a difference between the current GPS position and a previous GPS position is greater than a first threshold difference, and a second condition, in which a difference between the current GPS position and the estimated current position is less than a second threshold difference, are satisfied.

2. The method of claim 1 , wherein the map represents roads using multiple waypoints on a single line.

3. The step of acquiring a map direction angle includes: Detecting the nearest waypoint from the object based on the last estimated position of the object; calculating a map orientation angle of the object based on the detected waypoint and a waypoint subsequent to the detected waypoint; The object positioning method of claim 1 , comprising:

4. The step of acquiring a map direction angle includes: Detecting one of the waypoints based on the last estimated position of the object; determining a map orientation angle corresponding to the detected waypoint as a map orientation angle of the object; The object positioning method of claim 1 , comprising:

5. 2. The object positioning method of claim 1, wherein the vehicle is one of a car, a truck, a tractor, a scooter, a motorcycle, a cycle, an amphibious vehicle, a snowmobile, a boat, a public transportation vehicle, a bus, a monorail, an electric vehicle (EV), and a drone.

6. The object positioning method of claim 1 , wherein the sensors include an accelerometer sensor and a direction sensor.

7. the object is a vehicle, The step of acquiring the velocity of the object and the sensor detected direction angle detected by the sensor includes: acquiring an initial direction angle by a GPS sensor; acquiring a steering wheel rotation angle of the vehicle from a sensor of the vehicle; calculating a direction angle of the object by applying the handle rotation angle to the initial direction angle; The object positioning method of claim 1 , comprising:

8. the object is a vehicle, The step of acquiring the velocity of the object and the sensor detected direction angle detected by the sensor includes: obtaining wheel speeds of the vehicle from sensors of the vehicle; calculating a velocity of the object based on the wheel speed; The object positioning method of claim 1 , comprising:

9. 9. The method of claim 1, wherein the plurality of waypoints are generated based on position information recorded along a lane on a road.

10. The object positioning method according to claim 1 , wherein the plurality of waypoints are generated by converting position information recorded on a lane on a road so as to represent a single lane.

11. The object positioning method according to claim 1 , wherein the previous GPS position and the current GPS position are corrected based on the velocity of the object and the sensor-detected direction angle.

12. The method of claim 1 , wherein updating the current location comprises updating the estimated current location to the current GPS location in response to the current GPS location being bounced.

13. The object positioning method according to claim 12 , wherein the current GPS position is corrected based on the velocity of the object and the sensor-detected direction angle.

14. A computer program that causes a computer of an object positioning device to execute the object positioning method according to any one of claims 1 to 13.

15. a sensor for acquiring the position of an object; a memory storing a plurality of waypoints generated based on the instructions and recorded position information along a lane of a road; a processor for executing said instructions; The instruction: obtaining a reference position based on the position; detecting one of the waypoints that is closest to the object; calculating a map orientation angle of the object based on the detected waypoint and a waypoint subsequent to the detected waypoint; Using at least one sensor, acquiring a velocity of the object and a sensor-detected direction angle detected by the sensor; generating a second direction angle, comparing the map direction angle with the sensor detected direction angle to determine a difference between the map direction angle and the sensor detected direction angle, and generating the second direction angle based on both the map direction angle to which a first weight value has been applied and the sensor detected direction angle to which a second weight value has been applied, wherein the first weight value is greater than the second weight value when the difference between the map direction angle and the sensor detected direction angle is less than a threshold angle, and the first weight value is less than the second weight value when the difference between the map direction angle and the sensor detected direction angle is greater than the threshold angle; performing dead reckoning based on the reference position, the second direction angle, and the velocity; determining a current position of the object based on the dead reckoning results; wherein the object is a vehicle, and the step of estimating a current position of the object includes the step of generating lane change information for the object based on the estimated current position of the object, and the lane change information for the object is displayed on a display of an autonomous driving system of the vehicle and transmitted to a server or another vehicle; The step of acquiring the reference position includes: acquiring a current GPS position from a GPS sensor at a predefined interval; An object positioning device comprising: updating the reference position using the current GPS position when both a first condition, in which a difference between the current GPS position and a previous GPS position is greater than a first threshold difference, and a second condition, in which a difference between the current GPS position and the estimated current position is less than a second threshold difference, are satisfied.

16. The object positioning device according to claim 15 , wherein the memory stores map direction angles corresponding to the detected waypoints.

17. 17. The object positioning device according to claim 15 or 16, wherein the processor detects the next waypoint based on a perceived direction of the object.

Images