WO2017033752A1 - 走行軌道作成装置、方法及びプログラム、並びに、運転支援装置及びシステム - Google Patents

走行軌道作成装置、方法及びプログラム、並びに、運転支援装置及びシステム Download PDF

Info

Publication number
WO2017033752A1
WO2017033752A1 PCT/JP2016/073641 JP2016073641W WO2017033752A1 WO 2017033752 A1 WO2017033752 A1 WO 2017033752A1 JP 2016073641 W JP2016073641 W JP 2016073641W WO 2017033752 A1 WO2017033752 A1 WO 2017033752A1
Authority
WO
WIPO (PCT)
Prior art keywords
waveform
trajectory
ramp
traveling track
traveling
Prior art date
Application number
PCT/JP2016/073641
Other languages
English (en)
French (fr)
Inventor
山本 真
新太郎 大崎
哲二 柳澤
Original Assignee
株式会社三英技研
アイサンテクノロジー株式会社
株式会社トヨタマップマスター
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 株式会社三英技研, アイサンテクノロジー株式会社, 株式会社トヨタマップマスター filed Critical 株式会社三英技研
Priority to CN201680036296.XA priority Critical patent/CN108137048B/zh
Priority to EP16839099.5A priority patent/EP3296172B1/en
Priority to US15/737,271 priority patent/US10232851B2/en
Priority to JP2016570363A priority patent/JP6251421B2/ja
Publication of WO2017033752A1 publication Critical patent/WO2017033752A1/ja

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/10Path keeping
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W10/00Conjoint control of vehicle sub-units of different type or different function
    • B60W10/20Conjoint control of vehicle sub-units of different type or different function including control of steering systems
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/02Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
    • B60W40/06Road conditions
    • B60W40/072Curvature of the road
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W50/08Interaction between the driver and the control system
    • B60W50/14Means for informing the driver, warning the driver or prompting a driver intervention
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D6/00Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D6/00Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
    • B62D6/002Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits computing target steering angles for front or rear wheels
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W50/08Interaction between the driver and the control system
    • B60W50/14Means for informing the driver, warning the driver or prompting a driver intervention
    • B60W2050/146Display means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/06Direction of travel
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2552/00Input parameters relating to infrastructure
    • B60W2552/30Road curve radius
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2556/00Input parameters relating to data
    • B60W2556/45External transmission of data to or from the vehicle
    • B60W2556/50External transmission of data to or from the vehicle of positioning data, e.g. GPS [Global Positioning System] data
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2710/00Output or target parameters relating to a particular sub-units
    • B60W2710/20Steering systems

Definitions

  • the present invention relates to a traveling track creation device, method and program for creating a traveling track on which a vehicle travels on a road, and a driving support device and system.
  • Curves such as expressways and main arterial roads have an entry straight part that enters the curve, an entry clothoid part that follows the entry straight part, an arc part that follows the entry clothoid part, an exit clothoid part that follows the arc part, and an escape clothoid And an escape straight line portion following the portion. If the road is configured in this way, the vehicle can smoothly travel on the curve at a high speed, so that it is possible to suppress the side slip of the vehicle and to suppress occupant discomfort.
  • an intersection in an urban area has only an entry straight portion, an arc portion that continues to the entry straight portion, and an escape straight portion that follows the arc portion, and may not have an entry clothoid portion and an exit clothoid portion.
  • FIG. 23 is a plan view showing an example of an intersection.
  • This intersection 200 is a four-way road.
  • the vehicle 300 enters the intersection 200 along the arrow 201 from the left side in the drawing and escapes from the intersection 200 along the arrow 202 upward in the drawing, the vehicle 300 enters the entry straight portion 203 and the entry straight portion 203. It passes through the arc portion 204 that continues and the escape straight portion 205 that follows the arc portion 204.
  • Patent Document 1 discloses a driving support system that generates a virtual digital traveling track using line segments, arcs, clothoid curves, and the like based on road parameters and vehicle position information. It is disclosed.
  • the coordinates of the current position of the moving body are detected every predetermined time, and based on the detected coordinate group, a linear portion, a non-linear portion following the linear portion, and a non-linear portion are detected.
  • a road map creation device for creating a road map composed of a continuous straight line portion is disclosed.
  • a vehicle equipped with a driving support device that assists the steering operation of the driver or performs the steering operation on behalf of the driver assists the steering operation or performs the steering operation so as to travel along the road.
  • a driving support device that assists the steering operation of the driver or performs the steering operation on behalf of the driver assists the steering operation or performs the steering operation so as to travel along the road.
  • intersections that have signals and about 80 that do not have signals are intersections composed only of an entry straight portion, an arc portion that continues from the entry straight portion, and an escape straight portion that follows the arc portion. There are 10,000 places. Therefore, it is highly necessary to suppress the side slip of the vehicle and to suppress the discomfort of the passenger.
  • the present invention has been made in view of the above, and it is an object of the present invention to obtain a traveling track creation device, method and program, and a driving assistance device and system capable of creating a traveling track that allows a vehicle to travel smoothly.
  • a traveling track creation device includes an approach straight line portion, an arc portion that continues from the approach straight portion, and an escape straight portion that continues from the arc portion. And a trajectory creation device that creates a travel trajectory for a vehicle traveling on a road having a straight path, and an arc trajectory that follows the approach straight trajectory.
  • a curvature waveform creation unit for creating a waveform representing the curvature of the reference running track having an escape straight track following the arc track, and ramping each of the first edge and the second edge as two edges of the waveform
  • a first changing portion that provides a first ramp-like portion and a second ramp-like portion in the waveform, and both ends of each of the first ramp-like portion and the second ramp-like portion are changed to curves, 1 curve part, 2nd curve part, 3rd song
  • the first curve portion, the second curve portion, the third curve portion, and the fourth curve portion may be quadratic curves.
  • the first curve portion, the second curve portion, the third curve portion, and the fourth curve portion are hyperbolic tangent function curves or sigmoid function curves. Also good.
  • the second changing unit directly connects the first curved portion and the second curved portion, and directly connects the third curved portion and the fourth curved portion. May be.
  • the first change unit includes a midpoint between the first ramp part and the second ramp part that overlaps the first edge part and the second edge part, respectively.
  • the first ramp-shaped portion and the second ramp-shaped portion may be provided.
  • the driving support apparatus includes a travel trajectory creation apparatus according to the first aspect of the present invention, a display unit that displays an image, and a travel trajectory display that displays the travel trajectory on the display unit. And a section.
  • a driving assistance apparatus is configured such that the traveling track creation apparatus according to the first aspect of the present invention, an actuator that rotates the steering column of the vehicle, and the vehicle travels on the traveling path. And an actuator controller that rotates the steering column by operating the actuator.
  • the travel trajectory creation device may further include a recording medium writing unit that writes the travel trajectory to the recording medium.
  • a driving support device that includes a recording medium reading unit that reads a traveling track recorded on a recording medium by the traveling track creation device, a display unit that displays an image, and a traveling track. And a traveling track display unit to be displayed on the unit.
  • a driving support device comprising: a recording medium reading unit that reads a traveling track recorded on a recording medium by the traveling track creation device; an actuator that rotates a steering column of the vehicle; And an actuator control unit that rotates the steering column by operating the actuator so as to travel on the traveling track.
  • a driving assistance system is a driving assistance system comprising a driving assistance device mounted on a vehicle and a traveling trajectory creation device that communicates with the driving assistance device.
  • the device is a current location receiving unit that receives the current location of the vehicle from the driving support device, and a trajectory when the vehicle travels along the road, and includes an approach linear trajectory, an arc trajectory following the approach linear trajectory, and an arc trajectory.
  • a curvature waveform creating unit for creating a waveform representing the curvature of the reference running track having a subsequent escape straight track, and changing each of the first edge portion and the second edge portion which are two edges of the waveform into a ramp shape,
  • a first changing portion for providing a first ramp-shaped portion and a second ramp-shaped portion on the waveform, and both ends of the first ramp-shaped portion and the second ramp-shaped portion are changed to curves, and the first curved portion, 2 curve part, 3rd curve
  • a second changing unit for providing a fourth curved portion, a traveling track creating unit for creating a traveling track based on the waveform, and a traveling track transmitting unit for transmitting the traveling track to the driving support device, Includes a display unit that displays an image, a traveling track receiving unit that receives the traveling track from the traveling track creation device, and a traveling track display unit that displays the traveling track on the display unit.
  • a driving support system is a driving support system that includes a driving support device mounted on a vehicle and a travel track creation device that communicates with the drive support device.
  • the device is a current location receiving unit that receives the current location of the vehicle from the driving support device, and a trajectory when the vehicle travels along the road, and includes an approach linear trajectory, an arc trajectory following the approach linear trajectory, and an arc trajectory.
  • a curvature waveform creating unit for creating a waveform representing the curvature of the reference running track having a subsequent escape straight track, and changing each of the first edge portion and the second edge portion which are two edges of the waveform into a ramp shape,
  • a first changing portion for providing a first ramp-shaped portion and a second ramp-shaped portion on the waveform, and both ends of the first ramp-shaped portion and the second ramp-shaped portion are changed to curves, and the first curved portion, 2 curve part, 3rd curve
  • a second changing unit for providing a fourth curved portion, a traveling track creating unit for creating a traveling track based on the waveform, and a traveling track transmitting unit for transmitting the traveling track to the driving support device,
  • the travel track creation method is a travel track that creates a travel track on which a vehicle travels on a road having an entry straight line portion, an arc portion that follows the entry straight portion, and an escape straight portion that follows the arc portion.
  • This is a creation method, which is a trajectory when a vehicle travels along a road, and is a reference traveling trajectory having an approach straight trajectory, an arc trajectory following the approach straight trajectory, and an escape straight trajectory following the arc trajectory.
  • a curvature waveform creating step for creating a waveform representing curvature, and each of the first edge and the second edge, which are two edges of the waveform, are changed to a ramp shape, and the first ramp shape portion and the second ramp shape are changed to the waveform.
  • a first changing step for providing a portion, and changing both ends of each of the first ramp-like portion and the second ramp-like portion into a curve, and the waveform includes a first curve portion, a second curve portion, a third curve portion, and a fourth curve.
  • the traveling track creation program is for creating a traveling track in which a vehicle travels on a road having an entry straight portion, an arc portion following the entry straight portion, and an escape straight portion following the arc portion.
  • a traveling trajectory creation program executed by a computer which is a trajectory when a vehicle travels along a road, and includes an approaching linear trajectory, an arc trajectory following the approaching linear trajectory, an exiting linear trajectory following the arc trajectory,
  • a curvature waveform creating step for creating a waveform representing the curvature of the reference running track having the first and second edges, which are two edges of the waveform, are changed to a ramp shape, and the waveform is a first ramp shape.
  • FIG. 1 is a diagram illustrating a configuration of the driving support apparatus according to the first embodiment.
  • FIG. 2 is a diagram illustrating functional blocks of the traveling track creation device according to the first embodiment.
  • FIG. 3 is a flowchart of a process performed by the driving support apparatus according to the first embodiment.
  • FIG. 4 is a plan view illustrating an example of a road included in the map represented by the map data according to the first embodiment.
  • FIG. 5 is a diagram illustrating an example of a waveform representing the curvature of the road according to the first embodiment.
  • FIG. 6 is a diagram illustrating an example of a waveform created by the driving support apparatus according to the first embodiment.
  • FIG. 7 is a diagram illustrating an example of a waveform created by the driving assistance apparatus according to the first embodiment.
  • FIG. 1 is a diagram illustrating a configuration of the driving support apparatus according to the first embodiment.
  • FIG. 2 is a diagram illustrating functional blocks of the traveling track creation device according to the first embodiment.
  • FIG. 8 is a partially enlarged view of an example of a waveform created by the driving assistance apparatus according to the first embodiment.
  • FIG. 9 is a diagram illustrating an example of a traveling track created by the driving assistance apparatus according to the first embodiment.
  • FIG. 10 is a diagram illustrating a second-order differential waveform of the curvature of the traveling track according to the first embodiment.
  • FIG. 11 is a diagram illustrating a configuration of the driving support system according to the second embodiment.
  • FIG. 12 is a diagram illustrating functional blocks of the driving support apparatus according to the second embodiment.
  • FIG. 13 is a diagram illustrating functional blocks of the traveling track creation device according to the second embodiment.
  • FIG. 14 is a sequence diagram illustrating an operation of the driving support system according to the second embodiment.
  • FIG. 15 is a diagram illustrating a configuration of the driving support system according to the third embodiment.
  • FIG. 16 is a flowchart illustrating processing of the driving support apparatus according to the fourth embodiment.
  • FIG. 17 is a diagram illustrating an example of a waveform created by the driving assistance apparatus according to the fourth embodiment.
  • FIG. 18 is a diagram illustrating an example of a waveform created by the driving assistance apparatus according to the fourth embodiment.
  • FIG. 19 is a diagram illustrating an example of a waveform created by the driving assistance apparatus according to the fifth embodiment.
  • FIG. 20 is a diagram illustrating an example of a waveform created by the driving assistance apparatus according to the fifth embodiment.
  • FIG. 21 is a partially enlarged view of an example of a waveform created by the driving support apparatus according to the fifth embodiment.
  • FIG. 22 is a partially enlarged view of the second-order differential waveform of the curvature of the traveling track according to the fifth embodiment.
  • FIG. 23 is a plan view showing an example of an intersection.
  • FIG. 1 is a diagram illustrating a configuration of the driving support apparatus according to the first embodiment.
  • This driving support device 1 is mounted on a vehicle 50.
  • the driving support device 1 includes a traveling track creation device 2, a display unit 24, and an actuator 25.
  • the traveling track creation device 2 includes a position detection unit 21, a storage unit 22, and a control unit 23.
  • the position detection unit 21 includes a GPS receiver 21a, a gyroscope 21b, a distance sensor 21c, and a geomagnetic sensor 21d.
  • the GPS receiver 21 a receives radio waves from a GPS (Global Positioning System) artificial satellite, detects the position, direction (traveling direction), speed, acceleration, and the like of the vehicle 50 and outputs the detected position to the control unit 23.
  • GPS Global Positioning System
  • the gyroscope 21 b is a sensor for detecting the angular velocity (direction change amount) of the vehicle 50, and outputs a detection signal corresponding to the angular velocity of the rotational motion applied to the vehicle 50 to the control unit 23.
  • the distance sensor 21 c detects the distance traveled by the vehicle 50 based on the longitudinal acceleration of the vehicle 50 and outputs the detected distance to the control unit 23.
  • the geomagnetic sensor 21d is an azimuth sensor using a semiconductor, detects the azimuth (traveling direction) based on the north-south geomagnetism generated on the earth, and outputs it to the control unit 23.
  • the storage unit 22 stores map data 22a and an automatic operation setting flag 22b.
  • the storage unit 22 is exemplified by SSD (Solid State Drive) or HDD (Hard Disk Drive).
  • the map data 22a includes map data of a curve or an intersection having only an approach straight portion, an arc portion continuing from the approach straight portion, and an exit straight portion continuing from the arc portion, and not having the approach clothoid portion and the exit clothoid portion. Including.
  • the automatic driving setting flag 22b is set to “1” when the driving support device 1 performs automatic driving of the vehicle 50, and is set to “0” when the driving support device 1 does not perform automatic driving of the vehicle 50. It is set in advance.
  • the control unit 23 includes a CPU (Central Processing Unit) 23a, a ROM (Read Only Memory) 23b, and a RAM (Random Access Memory) 23c.
  • the CPU 23a, ROM 23b, and RAM 23c are connected via the bus B.
  • the CPU 23a executes the program stored in the ROM 23b while using the RAM 23c as a work area. Note that the program may be stored in the storage unit 22.
  • the display unit 24 displays a map and an image of a traveling track on which the vehicle 50 travels based on the data output from the control unit 23.
  • the display unit 24 is exemplified by a liquid crystal display device or an organic EL (Electro Luminescence) display device.
  • the actuator 25 is connected to the steering column 51 of the vehicle 50, and rotates the steering column 51 based on a control signal output from the control unit 23 when the driving support device 1 performs automatic driving. Thereby, the azimuth
  • the actuator 25 is exemplified by a motor or a hydraulic pump.
  • FIG. 2 is a functional block diagram of the traveling track creation device according to the first embodiment.
  • the CPU 23a executes a program stored in the ROM 23b. Thereby, the map data reading unit 41, the curvature waveform creating unit 42, the first changing unit 43, the second changing unit 44, the traveling track creating unit 45, the traveling track display unit 46, and the actuator control unit 47 are realized.
  • the map data reading unit 41 reads the map data 22a from the storage unit 22.
  • the curvature waveform creation unit 42 is a trajectory when the vehicle 50 travels along a road, and has a reference travel having an approach straight trajectory, an arc trajectory following the approach straight trajectory, and an escape straight trajectory following the arc trajectory. Create a waveform that represents the curvature of the orbit.
  • the first changing unit 43 changes each of the first edge portion and the second edge portion, which are two edges of the waveform, into a ramp shape, and provides a first ramp shape portion and a second ramp shape portion in the waveform.
  • the second changing unit 44 changes both ends of each of the first ramp-shaped portion and the second ramp-shaped portion into a curve, and adds a first curve portion, a second curve portion, a third curve portion, and a fourth curve portion to the waveform.
  • the traveling track creation unit 45 creates a traveling track based on the waveform.
  • the traveling track display unit 46 displays the traveling track on the display unit 24.
  • the actuator control unit 47 rotates the steering column 51 by operating the actuator 25 so that the vehicle 50 travels on the traveling track.
  • FIG. 3 is a flowchart of a process performed by the driving support apparatus according to the first embodiment.
  • the driving assistance apparatus 1 starts the process shown in FIG. 3 when the distance between the vehicle 50 and the curve or the intersection reaches a predetermined distance.
  • the map data reading unit 41 reads the map data 22a from the storage unit 22 in step S100.
  • FIG. 4 is a plan view showing an example of a road included in the map represented by the map data according to the first embodiment.
  • the horizontal axis direction is the X-axis direction
  • the vertical axis direction is the Y-axis direction.
  • the road 100 includes an approach straight line portion 101, an arc portion 102 that follows the approach straight portion 101, and an escape straight portion 103 that follows the arc portion 102.
  • only one lane is shown, and the opposite lane is not shown.
  • the reference traveling track 104 is included in the map data 22a.
  • the reference traveling track 104 is a track when the vehicle 50 travels along the road 100, and the center line of the road 100 is exemplified.
  • the reference traveling track 104 has an approach linear track 104 a in the approach straight portion 101, an arc track 104 b following the approach straight track 104 a in the arc portion 102, and an escape following the arc track 104 b in the escape straight portion 103. It has a straight track 104c.
  • the circular arc trajectory 104b is an arc having a radius R with the point 105 as the center.
  • the approach straight track 104a and the arc track 104b are connected at a point 104d located at the boundary between the approach straight portion 101 and the arc portion 102.
  • the circular arc track 104 b and the escape straight track 104 c are connected at a point 104 e located at the boundary between the circular arc portion 102 and the escape straight track 103.
  • the curvature waveform creating unit 42 creates a waveform representing the curvature of the reference traveling track 104 in step S102.
  • FIG. 5 is a diagram illustrating an example of a waveform representing the curvature of the road according to the first embodiment.
  • the horizontal axis direction is the X-axis direction
  • the vertical axis direction is the curvature.
  • the curvature of the approaching linear trajectory 104a is zero.
  • the curvature of the circular arc trajectory 104b is 1 / R.
  • the curvature of the escape straight track 104c is zero.
  • the curvature waveform creation unit 42 corresponds to the approach straight track 104a, the first portion 110a having a curvature of 0, the second portion 110b corresponding to the circular arc track 104b, and having a curvature of 1 / R, and an escape straight line.
  • a waveform 110 having a third portion 110c corresponding to the trajectory 104c and having a curvature of 0 is created.
  • the waveform 110 only needs to be created in the RAM 23c and does not need to be displayed on the display unit 24.
  • first edge part 110d Between the first part 110a and the second part 110b is the first edge part 110d, and between the second part 110b and the third part 110c is the second edge part 110e.
  • the lateral acceleration of the vehicle 50 is proportional to the curvature.
  • the lateral direction refers to a direction orthogonal to the traveling direction of the vehicle 50. That is, the waveform 110 representing the curvature of the reference traveling track 104 is also a waveform representing the lateral acceleration of the vehicle 50 traveling on the reference traveling track 104. Therefore, in the first edge portion 110d and the second edge portion 110e, the lateral acceleration of the vehicle 50 changes abruptly, and the possibility of the skidding of the vehicle 50 increases and passenger discomfort increases.
  • the first changing unit 43 changes the first edge portion 110d and the second edge portion 110e of the waveform 110 into a ramp shape, and the first ramp shape portion 110f and the second ramp shape.
  • a portion 110g is provided.
  • FIG. 6 is a diagram illustrating an example of a waveform created by the driving support apparatus according to the first embodiment.
  • the 1st change part 43 changes the 1st edge part 110d of the waveform 110 into a ramp shape, and provides the 1st ramp shape part 110f.
  • the 1st change part 43 provides the 1st ramp-shaped part 110f which makes the lower end of the 1st edge part 110d the starting point 110h. Accordingly, the end point 110i of the first ramp-like portion 110f is on the front side in the traveling direction relative to the first edge portion 110d.
  • the first changing unit 43 changes the second edge portion 110e of the waveform 110 into a ramp shape, and provides a second ramp-shaped portion 110g.
  • the 1st change part 43 provides the 2nd ramp-shaped part 110g which makes the lower end of the 2nd edge part 110e the end point 110j. Accordingly, the starting point 110k of the second ramp-shaped portion 110g is closer to the traveling direction than the second edge portion 110e.
  • the second changing unit 44 changes both ends of the first ramp-shaped portion 110f and the second ramp-shaped portion 110g to curves, and the first curved portion 110l and the second curved portion 110m.
  • the third curve portion 110n and the fourth curve portion 110o are provided.
  • FIG. 7 is a diagram illustrating an example of a waveform created by the driving support apparatus according to the first embodiment.
  • the second changing unit 44 changes the end of the first ramp-like part 110f on the start point 110h side to the first curved part 110l.
  • the second changing unit 44 has a tangent at the point 110p on the front side in the traveling direction coincides with the first portion 110a, and a tangent at the point 110q on the front side in the traveling direction is the first ramp-shaped part 110f.
  • a first curve portion 110l that is a coincident quadratic curve is provided. Accordingly, the first curved portion 110l straddles the first edge portion 110d.
  • the second changing unit 44 changes the end portion on the end point 110i side of the first ramp-like portion 110f to the second curved portion 110m.
  • the second changing unit 44 has the tangent at the point 110r on the front side in the traveling direction coincides with the first ramp-shaped part 110f, and the tangent at the point 110s on the front side in the traveling direction is the second part 110b.
  • a second curve portion 110m that is a coincident quadratic curve is provided.
  • the second changing unit 44 changes the end of the second ramp-shaped part 110g on the start point 110k side to the third curved part 110n.
  • the second changing unit 44 has the tangent at the point 110t on the front side in the traveling direction coincides with the second portion 110b, and the tangent at the point 110u on the front side in the traveling direction is the second ramp-shaped part 110g.
  • a third curve portion 110n that is a coincident quadratic curve is provided.
  • the second changing unit 44 changes the end of the second ramp-like part 110g on the end point 110j side to the fourth curved part 110o.
  • the second changing unit 44 has the tangent at the point 110v on the front side in the traveling direction coincides with the second ramp 110g, and the tangent at the point 110w on the front side in the traveling direction is the third part 110c.
  • a fourth curve portion 110o that is a coincident quadratic curve is provided. Therefore, the fourth curved portion 110o straddles the second edge portion 110e.
  • each of the points 110p to 110s and the points 110t to 110w is referred to as a “roll jerk curve”.
  • FIG. 8 is a partially enlarged view of an example of a waveform created by the driving support apparatus according to the first embodiment.
  • FIG. 8 is an enlarged view of the vicinity of the first ramp-like portion 110f of FIG.
  • the second changing unit 44 changes the end of the first ramp-like part 110f on the start point 110h side to the first curved part 110l.
  • the second changing unit 44 has a tangent at the point 110p on the front side in the traveling direction coincides with the first portion 110a, and a tangent at the point 110q on the front side in the traveling direction is the first ramp-shaped part 110f.
  • a first curve portion 110l that is a coincident quadratic curve is provided. Accordingly, the first curved portion 110l straddles the first edge portion 110d.
  • the second changing unit 44 changes the end portion on the end point 110i side of the first ramp-like portion 110f to the second curved portion 110m.
  • the second changing unit 44 has a tangent line at the point 110r on the front side in the traveling direction coincides with the first ramp-shaped part 110f, and a tangent line at the point 110s on the front side in the traveling direction is the second part 110b.
  • a second curve portion 110m that is a coincident quadratic curve is provided.
  • the first curve portion 110l, the second curve portion 110m, the third curve portion 110n, and the fourth curve portion 110o are quadratic curves.
  • the present invention is not limited to this.
  • Other examples of the first curve portion 110l, the second curve portion 110m, the third curve portion 110n, and the fourth curve portion 110o include a cubic or higher order curve or an exponential curve.
  • the traveling track creation unit 45 creates the traveling track 120 based on the waveform 110 in step S108.
  • FIG. 9 is a diagram illustrating an example of a traveling track created by the driving support apparatus according to the first embodiment.
  • the traveling track creation unit 45 can create the traveling track 120 by scanning the waveform 110 at regular intervals and plotting points on the road 100 based on the curvature at each scanning point.
  • the waveform 110 is not changed from the origin O to the point 110p. Therefore, the traveling trajectory creation unit 45 creates a straight trajectory 120A along the approach straight trajectory 104a up to the point 120a having the same X coordinate as the point 110p.
  • the points 110p to 110q of the waveform 110 are changed to the first curve part 110l which is a quadratic curve. Therefore, the traveling trajectory creation unit 45 creates a trajectory 120B having a quadratic curvature from the point 120a having the same X coordinate as the point 110p to the point 120b having the same X coordinate as the point 110q.
  • the point 120a is closer to the front side in the traveling direction than the boundary between the approach straight line portion 101 and the arc portion 102. Accordingly, the traveling track 120 starts to bend from the front side in the traveling direction as compared to the reference traveling track 104.
  • the point 110q to the point 110r of the waveform 110 is changed to the first ramp portion 110f. Therefore, the traveling trajectory creation unit 45 creates a trajectory 120C having a ramp-like curvature from the point 120b having the same X coordinate as the point 110q to the point 120c having the same X coordinate as the point 110r.
  • a curve having a ramp-like curvature is a clothoid curve. Accordingly, the track 120C becomes a clothoid curve.
  • the point 110r to the point 110s of the waveform 110 is changed to a second curve part 110m that is a quadratic curve. Accordingly, the traveling trajectory creation unit 45 creates a trajectory 120D having a quadratic curvature from a point 120c having the same X coordinate as the point 110r to a point 120d having the same X coordinate as the point 110s.
  • the waveform 110 is not changed from the point 110s to the point 110t. Therefore, the traveling trajectory creation unit 45 creates an arc trajectory 120E, similar to the arc trajectory 104b, from the point 120d having the same X coordinate as the point 110s to the point 120e having the same X coordinate as the point 110t. Since the track 120B starts to bend from the front side in the traveling direction as compared to the reference travel track 104, the center point 121 of the track 120E is located farther from the road 100 than the center point 105 of the arc track 104b. .
  • the point 110t to the point 110u of the waveform 110 is changed to a third curve part 110n that is a quadratic curve. Accordingly, the traveling trajectory creation unit 45 creates a trajectory 120F having a quadratic curvature from the point 120e having the same X coordinate as the point 110t to the point 120f having the same X coordinate as the point 110u.
  • the point 110u to the point 110v of the waveform 110 is changed to the second ramp portion 110g. Therefore, the traveling trajectory creation unit 45 creates a trajectory 120G having a ramp-like curvature from the point 120f having the same X coordinate as the point 110u to the point 120g having the same X coordinate as the point 110v.
  • a curve having a ramp-like curvature is a clothoid curve. Therefore, the trajectory 120G becomes a clothoid curve.
  • the point 110v to the point 110w of the waveform 110 are changed to a fourth curve part 110o that is a quadratic curve. Therefore, the traveling trajectory creation unit 45 creates a trajectory 120H whose curvature is a quadratic curve from a point 120g having the same X coordinate as the point 110v to a point 120h having the same X coordinate as the point 110w.
  • the point 120h is a forward direction side rather than the connection part of the circular arc part 102 and the escape straight part 103. FIG. Therefore, the traveling track 120 continues to bend to the front side in the traveling direction from the reference traveling track 104.
  • the traveling trajectory creation unit 45 creates a straight trajectory 120I along the escape straight trajectory 104c from the point 120h where the X coordinate is the same as the point 110w on the front side in the traveling direction.
  • the traveling track 120 includes tracks 120A, 120B, 120C, 120D, 120E, 120F, 120G, 120H, and 120I.
  • each of the points 120a to 120d and the points 120e to 120h is referred to as a “roll jerk traveling track”.
  • the lateral acceleration of the vehicle 50 is directly proportional to the curvature. That is, the waveform 110 representing the curvature of the traveling track 120 is also a waveform representing the lateral acceleration of the vehicle 50 traveling on the traveling track 120.
  • the waveform 110 increases smoothly from the point 110p to the point 110s and decreases smoothly from the point 110t to the point 110w. Accordingly, the lateral acceleration of the vehicle 50 traveling on the traveling track 120 changes smoothly. That is, the driving assistance device 1 can create the traveling track 120 that allows the vehicle 50 to travel smoothly. Thereby, the driving assistance apparatus 1 can suppress the possibility of skidding of the vehicle 50 and can suppress the discomfort of the occupant.
  • the traveling track display unit 46 displays the traveling track 120 on the display unit 24 so as to overlap the map.
  • the user operates the steering so that the vehicle 50 travels on the traveling track 120 displayed on the display unit 24.
  • the lateral acceleration of the vehicle 50 changes smoothly. Therefore, the occurrence of skidding of the vehicle 50 can be suppressed, and passenger discomfort can be suppressed.
  • the actuator control unit 47 determines whether or not the automatic operation setting flag 22b is “1” in step S112. If the actuator control unit 47 determines that the automatic operation setting flag 22b is “1” (Yes), the process proceeds to step S114, and if it is determined that the automatic operation setting flag 22b is “0” (No), the processing is performed. Exit.
  • step S114 the actuator controller 47 rotates the steering column 51 by operating the actuator 25 so that the vehicle 50 travels on the travel track 120, and ends the process. Thereby, the lateral acceleration of the vehicle 50 changes smoothly. That is, the driving assistance apparatus 1 can drive the vehicle 50 smoothly. Therefore, the driving assistance device 1 can suppress the possibility of skidding of the vehicle 50 and can suppress occupant discomfort.
  • FIG. 10 is a diagram illustrating a second-order differential waveform of the curvature of the traveling track according to the first embodiment.
  • the curvature of the traveling track 120 is directly proportional to the lateral acceleration of the vehicle 50.
  • the first-order derivative of the curvature of the traveling track 120 is directly proportional to the lateral jerk (jerk, jerk) of the vehicle 50.
  • the second order derivative of the curvature of the traveling track 120 is directly proportional to the rate of change of the jerk in the lateral direction of the vehicle 50.
  • the range from the origin O to the point 110p of the curvature waveform 110 is zero. Accordingly, the portion 130a of the second-order differential waveform 130 of the curvature of the traveling track 120 from the origin O to the location corresponding to the point 110p is zero.
  • the point 110p to the point 110q of the waveform 110 is a quadratic curve. Accordingly, a portion 130b of the waveform 130 from a location corresponding to the point 110p to a location corresponding to the point 110q is a positive constant.
  • the points 110q to 110r of the waveform 110 are ramp-shaped. Accordingly, the portion 130c of the waveform 130 from the location corresponding to the point 110q to the location corresponding to the point 110r is zero.
  • the point 110r to the point 110s of the waveform 110 is a quadratic curve. Accordingly, a portion 130d of the waveform 130 from a location corresponding to the point 110r to a location corresponding to the point 110s is a negative constant.
  • the points 110s to 110t of the waveform 110 are positive constants. Accordingly, the portion 130e of the waveform 130 from the location corresponding to the point 110s to the location corresponding to the point 110t is zero.
  • the point 110t to the point 110u of the waveform 110 is a quadratic curve. Accordingly, a portion 130f of the waveform 130 from a location corresponding to the point 110t to a location corresponding to the point 110u is a negative constant.
  • the point 110u to the point 110v of the waveform 110 has a ramp shape. Therefore, the portion 130g of the waveform 130 from the location corresponding to the point 110u to the location corresponding to the point 110v is zero.
  • the point 110v to the point 110w of the waveform 110 is a quadratic curve. Accordingly, the portion 130h of the waveform 130 from the location corresponding to the point 110v to the location corresponding to the point 110w is a positive constant.
  • the waveform 110 after the point 110w is 0. Accordingly, the portion 130 i of the waveform 130 after the portion corresponding to the point 110 w is zero.
  • the driving support device 1 can create the traveling track 120 in which the lateral acceleration of the vehicle 50 changes smoothly. That is, the driving assistance device 1 can create the traveling track 120 that allows the vehicle 50 to travel smoothly. Thereby, the driving assistance device 1 can suppress the occurrence of skidding of the vehicle 50 and can suppress the discomfort of the occupant.
  • the driving support device 1 can create the traveling track 120 from the reference traveling track 104 that is a single road (polyline) in the map data 22a.
  • the driving support device 1 operates the actuator 25 so that the vehicle 50 travels on the travel track 120 and rotates the steering column 51.
  • the conventional driving assistance device it is necessary to perform feedback control that detects the traveling state of the vehicle 50 and adjusts the control amount in order to suppress the possibility of skidding of the vehicle 50 and to suppress the discomfort of the occupant. It was.
  • the driving assistance device 1 can perform feedforward control so that the vehicle 50 travels on the traveling track 120, the configuration can be simplified and can be manufactured at low cost.
  • FIG. FIG. 11 is a diagram illustrating a configuration of the driving support system according to the second embodiment.
  • symbol is attached
  • the driving support system 60 includes a driving support device 1A mounted on the vehicle 50 and a server 70.
  • the driving support device 1A performs wireless communication with the server 70 in addition to the position detection unit 21, the storage unit 22, the control unit 23, the display unit 24, and the actuator 25 that are components of the driving support device 1 according to the first embodiment.
  • a communication unit 26 is further provided.
  • the wireless communication is exemplified by W-CDMA (Wideband Code Division Multiple Access) or LTE (Long Term Evolution).
  • the server 70 includes a communication unit 71 that performs wireless communication with the driving support device 1 ⁇ / b> A, and a traveling track creation device 80.
  • the traveling track creation device 80 includes a control unit 81 and a storage unit 82.
  • the control unit 81 includes a CPU 81a, a ROM 81b, and a RAM 81c.
  • the CPU 81a, ROM 81b, and RAM 81c are connected via the bus B1.
  • the CPU 81a executes the program stored in the ROM 82b while using the RAM 81c as a work area.
  • the program may be stored in the storage unit 82.
  • the storage unit 82 stores map data 82a.
  • the storage unit 82 is exemplified by an SSD or an HDD.
  • FIG. 12 is a functional block diagram of the driving support apparatus according to the second embodiment.
  • the CPU 23a executes a program stored in the ROM 23b. Thereby, the traveling track display unit 46, the actuator control unit 47, the current location transmission unit 48, and the traveling track reception unit 48 are realized.
  • the current location transmission unit 48 transmits the current location of the vehicle 50 to the server 70.
  • the traveling track receiving unit 49 receives the traveling track from the server 70.
  • FIG. 13 is a functional block diagram of the traveling track creation device according to the second embodiment.
  • the CPU 81a executes a program stored in the ROM 81b. Thereby, the map data reading unit 41, the curvature waveform creating unit 42, the first changing unit 43, the second changing unit 44, the traveling track creating unit 45, the current location receiving unit 83, and the traveling track transmitting unit 84 are realized.
  • the current location receiving unit 83 receives the current location of the vehicle 50 from the driving support device 1A.
  • the traveling track transmission unit 84 transmits the traveling track to the driving support device 1A.
  • FIG. 14 is a sequence diagram illustrating the operation of the driving support system according to the second embodiment.
  • the driving support device 1A starts the process illustrated in FIG.
  • the current location transmission unit 48 of the driving support device 1A transmits data representing the current location of the vehicle 50 to the server 70 in step S200.
  • the current location receiving unit 83 of the server 70 receives data representing the current location of the vehicle 50 from the driving support device 1A.
  • step S202 the map data reading unit 41, the curvature waveform creation unit 42, the first change unit 43, the second change unit 44, and the traveling track creation unit 45 of the server 70 smoothly change the lateral acceleration of the vehicle 50. Create a running track.
  • step S202 contents of step S202 are the same as steps S100 to S108 shown in the flowchart of FIG. 3 of the first embodiment.
  • step S204 the traveling track transmission unit 84 of the server 70 transmits the traveling track to the driving support device 1A.
  • the traveling track receiving unit 49 of the driving assistance device 1 ⁇ / b> A receives the traveling track from the server 70.
  • step S206 the traveling track display unit 46 of the driving support device 1A displays the traveling track on the map on the display unit 24. Further, when the actuator control unit 47 of the driving support device 1A determines that the automatic driving setting flag 22b is “1”, in step S206, the actuator 25 is operated so that the vehicle 50 travels on the traveling track. The steering column 51 is rotated.
  • step S206 are the same as steps S110 to S114 shown in the flowchart of FIG. 3 of the first embodiment.
  • the driving support system 60 can create a traveling track on the server 70 side. Thereby, it is possible to eliminate the need to create a traveling track on the side of the driving assistance device 1A mounted on the vehicle 50, and to reduce the processing load on the CPU 23a of the driving assistance device 1A.
  • the CPU 23a mounted on the vehicle 50 may have a low processing capacity due to a request for mounting or a request for suppressing power consumption.
  • the driving support system 60 can create a traveling track on the server 70 side. Therefore, the driving support system 60 can create a traveling track on which the vehicle 50 can travel smoothly even when the processing capacity of the CPU 23a is low. As a result, the driving support system 60 can suppress the possibility of skidding of the vehicle 50 and can suppress the discomfort of the occupant.
  • FIG. 15 is a diagram illustrating a configuration of the driving support system according to the third embodiment.
  • symbol is attached
  • the driving support system 61 includes a driving support device 1B mounted on the vehicle 50 and a server 70A.
  • the driving support device 1B is recorded on the recording medium 90 in addition to the position detection unit 21, the storage unit 22, the control unit 23, the display unit 24, and the actuator 25 that are components of the driving support device 1 according to the first embodiment.
  • a recording medium reading unit 27 for reading the received data is further provided.
  • the server 70 ⁇ / b> A includes a recording medium writing unit 72 that writes data to the recording medium 90, and a traveling track creation device 80.
  • the recording medium 90 is exemplified by an SD card (registered trademark), a USB (Universal Serial Bus) memory, or a DVD (Digital Versatile Disc).
  • SD card registered trademark
  • USB Universal Serial Bus
  • DVD Digital Versatile Disc
  • the traveling track creation device 80 creates a traveling track on which the vehicle can smoothly travel for every curve or intersection in Japan, and records it on the recording medium 90.
  • the user of the vehicle 50 brings the recording medium 90 into the vehicle 50 and inserts it into the recording medium reading unit 27 of the driving support device 1B.
  • the driving support device 1B may install or copy the traveling track recorded in the recording medium 90 in the storage unit 22. Thereby, the user can remove the recording medium 90.
  • the driving support device 1B When the distance between the vehicle 50 and the curve or the intersection reaches a predetermined distance, the driving support device 1B reads the traveling track from the recording medium 90 or the storage unit 22, and superimposes the traveling track on the map. 24. Further, when the driving support device 1B determines that the automatic driving setting flag 22b is “1”, the driving column 1 is rotated by operating the actuator 25 so that the vehicle 50 travels on the traveling track.
  • the driving support system 61 can create a traveling track on the server 70A side. Thereby, it is possible to eliminate the need to create a traveling track on the side of the driving support device 1B mounted on the vehicle 50, and to reduce the processing load on the CPU 23a of the driving support device 1B.
  • the driving support system 61 can make wireless communication unnecessary compared with the driving support system 1A according to the second embodiment. Thereby, the driving support system 61 can reduce the manufacturing cost of the system and can reduce the communication cost, that is, the running cost.
  • Embodiment 4 The turning angular velocity (yaw angular velocity) r of the vehicle 50 is expressed by the following equation (1).
  • r (V / l) ⁇ (1)
  • V is the speed of the vehicle 50
  • l is the wheelbase of the vehicle 50
  • is the actual steering angle of the vehicle 50.
  • the area A of the region defined by the curvature waveform 110 of the reference traveling track 104 and the X axis shown in FIG. 5 represents the turning angle when the vehicle 50 travels on the reference traveling track 104.
  • the area B defined by the curvature waveform 110 of the traveling track 120 and the X axis shown in FIG. 7 represents the turning angle when the vehicle 50 travels on the traveling track 120.
  • the end point 110i of the first ramp-like portion 110f is closer to the traveling direction than the first edge portion 110d.
  • the starting point 110k of the second ramp-shaped portion 110g is closer to the front side in the traveling direction than the second edge portion 110e.
  • the area of the region defined by the curvature waveform 110 of the traveling track 120 shown in FIG. 7 and the X axis, that is, the turning angle when the vehicle 50 travels on the traveling track 120 is the reference traveling track 104 shown in FIG. Is smaller than the area of the region determined by the curvature waveform 110 and the X axis, that is, the turning angle when the vehicle 50 travels on the reference traveling track 104.
  • the turning angle becomes smaller than when the vehicle 50 travels on the reference travel track 104, and the vehicle 50 approaches the shoulder of the escape straight portion 103 of the road 100.
  • the safety of the vehicle 50 may not be ensured.
  • the vehicle 50 is prevented from approaching the shoulder of the escape straight portion 103 of the road 100, and the safety of the vehicle 50 is ensured.
  • FIG. 16 is a flowchart illustrating processing of the driving support apparatus according to the fourth embodiment.
  • the flowchart shown in FIG. 16 has step S104a instead of step S104 of the flowchart shown in FIG. 3 according to the first embodiment.
  • steps S100 and S102 in the flowchart shown in FIG. 16 are the same as steps S100 and S102 in the flowchart shown in FIG. 3 according to the first embodiment, a description thereof will be omitted.
  • step S104a the first changing unit 43 changes the first edge portion 110d and the second edge portion 110e of the waveform 110 to the first ramp-like portion 110f and the second ramp-like portion 110g, respectively, and the first ramp-like portion 110f.
  • the first ramp-like portion 110f and the second ramp-like portion 110g are provided so that the midpoint 110x overlaps the first edge portion 110d and the midpoint 110y of the second ramp-like portion 110g overlaps the second edge portion 110e.
  • FIG. 17 is a diagram illustrating an example of a waveform created by the driving support apparatus according to the fourth embodiment.
  • the 1st change part 43 changes the 1st edge part 110d of the waveform 110 into a ramp shape, and provides the 1st ramp shape part 110f.
  • the 1st change part 43 provides the 1st ramp-shaped part 110f so that the midpoint 110x of the 1st ramp-shaped part 110f may overlap with the 1st edge part 110d.
  • the first changing unit 43 changes the second edge portion 110e of the waveform 110 into a ramp shape, and provides a second ramp-shaped portion 110g.
  • the 1st change part 43 provides the 2nd ramp-shaped part 110g so that the midpoint 110y of the 2nd ramp-shaped part 110g may overlap with the 2nd edge part 110e.
  • step S106 the second changing unit 44 changes both ends of the first ramp-shaped portion 110f and the second ramp-shaped portion 110g to curves, and the first curved portion 110l and the second curved portion 110m.
  • the third curve portion 110n and the fourth curve portion 110o are provided.
  • FIG. 18 is a diagram illustrating an example of a waveform created by the driving support apparatus according to the fourth embodiment.
  • the second changing unit 44 changes the end of the first ramp-like part 110f on the start point 110h side to the first curved part 110l.
  • the second changing unit 44 has a tangent at the point 110p on the front side in the traveling direction coincides with the first portion 110a, and a tangent at the point 110q on the front side in the traveling direction is the first ramp-shaped part 110f.
  • a first curve portion 110l that is a coincident quadratic curve is provided.
  • the second changing unit 44 changes the end portion on the end point 110i side of the first ramp-like portion 110f to the second curved portion 110m.
  • the second changing unit 44 has a tangent at the point 110r on the front side in the traveling direction coincides with the first ramp-shaped part 110f, and a tangent at the point 110s on the front side in the traveling direction is the second part 110b.
  • a second curve portion 110m that is a coincident quadratic curve is provided.
  • the second changing unit 44 changes the end of the second ramp-shaped part 110g on the start point 110k side to the third curved part 110n.
  • the second changing unit 44 has the tangent at the point 110t on the front side in the traveling direction coincides with the second portion 110b, and the tangent at the point 110u on the front side in the traveling direction is the second ramp-shaped part 110g.
  • a third curve portion 110n that is a coincident quadratic curve is provided.
  • the second changing unit 44 changes the end of the second ramp-like part 110g on the end point 110j side to the fourth curved part 110o.
  • the second changing unit 44 has the tangent at the point 110v on the front side in the traveling direction coincides with the second ramp-shaped part 110g, and the tangent at the point 110w on the front side in the traveling direction is the third part 110c.
  • a fourth curve portion 110o that is a coincident quadratic curve is provided.
  • steps S108 to S114 in the flowchart shown in FIG. 16 are the same as steps S108 to S114 in the flowchart shown in FIG. 3 according to the first embodiment, description thereof will be omitted.
  • the middle point 110x of the first ramp-like portion 110f overlaps the first edge portion 110d. Accordingly, the area A defined by the X axis, the first edge portion 110d, and the waveform 110 is the same as the area B defined by the 1 / R straight line, the first edge portion 110d, and the waveform 110.
  • the middle point 110y of the second ramp-shaped part 110g overlaps the second edge part 110e. Therefore, the area C defined by the 1 / R straight line, the second edge portion 110e, and the waveform 110 is the same as the area D defined by the X axis, the second edge portion 110e, and the waveform 110.
  • the area of the region determined by the waveform 110 and the X axis shown in FIG. 18, that is, the turning angle when the vehicle 50 travels on the traveling track 120, is the area of the region determined by the waveform 110 and the X axis shown in FIG. That is, it is the same as the turning angle when the vehicle 50 travels on the reference travel track 104.
  • the driving assistance apparatus can suppress the vehicle 50 from approaching the shoulder of the escape straight portion 103 of the road 100, and can ensure the safety of the vehicle 50.
  • Embodiment 5 FIG.
  • a quadratic curve, a higher-order curve or an index higher than the third order The curve is illustrated.
  • the first curve portion 110l, the second curve portion 110m, the third curve portion 110n, and the fourth curve portion 110o are not limited to these.
  • Embodiment 5 describes a case where the first curve portion 110l, the second curve portion 110m, the third curve portion 110n, and the fourth curve portion 110o are hyperbolic tangent functions (hyperbolic tangent, tanh) curves.
  • step S104a the first changing unit 43 changes the first edge portion 110d and the second edge portion 110e of the waveform 110 to the first ramp-like portion 110f and the second ramp-like portion 110g, respectively, and the first ramp-like portion 110f.
  • the first ramp-like portion 110f and the second ramp-like portion 110g are provided so that the midpoint 110x overlaps the first edge portion 110d and the midpoint 110y of the second ramp-like portion 110g overlaps the second edge portion 110e.
  • FIG. 19 is a diagram illustrating an example of a waveform created by the driving support apparatus according to the fifth embodiment.
  • the 1st change part 43 changes the 1st edge part 110d of the waveform 110 into a ramp shape, and provides the 1st ramp shape part 110f.
  • the 1st change part 43 provides the 1st ramp-shaped part 110f so that the midpoint 110x of the 1st ramp-shaped part 110f may overlap with the 1st edge part 110d.
  • the first changing unit 43 changes the second edge portion 110e of the waveform 110 into a ramp shape, and provides a second ramp-shaped portion 110g.
  • the 1st change part 43 provides the 2nd ramp-shaped part 110g so that the midpoint 110y of the 2nd ramp-shaped part 110g may overlap with the 2nd edge part 110e.
  • the inclination of the first ramp-like part 110f and the second ramp-like part 110g is not limited, and may be an arbitrary inclination or a predetermined inclination.
  • step S106 the second changing unit 44 changes both ends of the first ramp-shaped portion 110f and the second ramp-shaped portion 110g to curves, and the first curved portion 110l, the second curved portion 110m, the third curved portion 110n, A fourth curved portion 110o is provided.
  • FIG. 20 is a diagram illustrating an example of a waveform created by the driving support apparatus according to the fifth embodiment.
  • the second changing unit 44 changes the end of the first ramp-like part 110f on the start point 110h side to the first curved part 110l.
  • the second changing unit 44 has the tangent at the point 110p on the front side in the traveling direction coincides with the first portion 110a, and the tangent at the midpoint 110x of the first ramp-shaped portion 110f is the first ramp-shaped.
  • a first curve portion 110l that is a hyperbolic tangent function curve that matches the portion 110f is provided.
  • the second changing unit 44 changes the end portion on the end point 110i side of the first ramp-like portion 110f to the second curved portion 110m.
  • the second changing unit 44 has the tangent at the midpoint 110x of the first ramp-shaped portion 110f coincides with the first ramp-shaped portion 110f, and the tangent at the point 110s on the traveling direction ahead side is the second.
  • a second curve portion 110m that is a hyperbolic tangent function curve that coincides with the portion 110b is provided.
  • the second changing unit 44 directly connects the first curved portion 110l and the second curved portion 110m at the midpoint 110x of the first ramp-shaped portion 110f. Accordingly, the first ramp-like portion 110f disappears from the waveform 110.
  • the second changing unit 44 changes the end of the second ramp-shaped part 110g on the start point 110k side to the third curved part 110n.
  • the second changing unit 44 has the tangent at the point 110t on the front side in the traveling direction coincides with the second portion 110b, and the tangent at the midpoint 110y of the second ramp-shaped portion 110g is the second ramp-shaped.
  • a third curve portion 110n which is a hyperbolic tangent function curve that matches the portion 110g, is provided.
  • the second changing unit 44 changes the end of the second ramp-like part 110g on the end point 110j side to the fourth curved part 110o.
  • the second changing unit 44 has a tangent at the middle point 110y of the second ramp-shaped part 110g coincides with the second ramp-shaped part 110g, and a tangent at the point 110w on the traveling direction ahead side is the third.
  • a fourth curve portion 110o that is a hyperbolic tangent function curve that matches the portion 110c is provided.
  • the second changing unit 44 directly connects the third curved portion 110h and the fourth curved portion 110o at the midpoint 110y of the second ramp-shaped portion 110g. Therefore, the second ramp-shaped portion 110g disappears from the waveform 110.
  • FIG. 21 is a partially enlarged view of an example of a waveform created by the driving support apparatus according to the fifth embodiment.
  • FIG. 21 is an enlarged view of the vicinity of the first curved portion 110l, the second curved portion 110m, the third curved portion 110n, and the fourth curved portion 110o of FIG.
  • the area A defined by the X axis, the first edge portion 110d, and the waveform 110 is the same as the area B defined by the 1 / R straight line, the first edge portion 110d, and the waveform 110.
  • the area C defined by the 1 / R straight line, the second edge 110e, and the waveform 110 is the same as the area D defined by the X-axis, the second edge 110e, and the waveform 110.
  • the area of the region determined by the waveform 110 and the X axis shown in FIG. 20, that is, the turning angle when the vehicle 50 travels on the traveling track, is the area of the region determined by the waveform 110 and the X axis shown in FIG. This is the same as the turning angle when the vehicle 50 travels on the reference travel track 104.
  • the driving assistance apparatus can suppress the vehicle 50 from approaching the shoulder of the escape straight portion 103 of the road 100, and can ensure the safety of the vehicle 50.
  • FIG. 22 is a partially enlarged view of the second-order derivative waveform of the curvature of the traveling track according to the fifth embodiment.
  • the curvature of the traveling track is directly proportional to the lateral acceleration of the vehicle 50.
  • the first-order derivative of the curvature of the traveling track is directly proportional to the lateral jerk (jerk, jerk) of the vehicle 50.
  • the second-order derivative of the curvature of the traveling track is directly proportional to the rate of change of the jerk in the lateral direction of the vehicle 50.
  • Equation (5) The second derivative of equation (5) is represented by the following equation (7).
  • y ′′ ⁇ 2sec 2 (x) ⁇ tanh (x) (7)
  • the portion 110a from the origin O to the point 110p of the curvature waveform 110 is zero. Accordingly, the portion 130a corresponding to the portion 110a of the second-order differential waveform 130 of the curvature of the traveling track is zero.
  • the first curve portion 110l of the waveform 110 from the point 110p to the point 110x is a hyperbolic tangent function curve.
  • the second derivative of the hyperbolic tangent function is as in the above equation (7). Therefore, a portion 130b of the waveform 130 corresponding to the first curve portion 110l is a curve represented by Expression (7).
  • the second curve portion 110m from the point 110x to the point 110s of the waveform 110 is a hyperbolic tangent function curve.
  • the second curve portion 110m is point-symmetric with the first curve portion 110l with the point 110x as the center. Therefore, a portion 130c of the waveform 130 from a location corresponding to the point 110x to a location corresponding to the point 110s is point-symmetric with the portion 130c with the point 130i as the center.
  • the portion 110b of the waveform 110 from the point 110s to the point 110t is a positive constant. Accordingly, the portion 130e of the waveform 130 up to the portion corresponding to the portion 110b is zero.
  • the third curve portion 110n from the point 110t to the point 110y of the waveform 110 is a hyperbolic tangent function curve.
  • the third curve portion 110n is symmetric with the second curve portion 110m with the straight line in the vertical axis direction as an axis. Therefore, the portion 130f of the waveform 130 corresponding to the third curved portion 110n is line symmetric with the portion 130c with the straight line in the vertical axis direction as the axis.
  • the fourth curve portion 110o from the point 110y to the point 110w of the waveform 110 is a hyperbolic tangent function curve.
  • the fourth curve portion 110o is line symmetric with the first curve portion 110l with the straight line in the vertical axis direction as the axis. Therefore, the portion 130g of the waveform 130 corresponding to the fourth curved portion 110o is symmetrical with the portion 130b about the straight line in the vertical axis direction.
  • the portion 110c after the point 110w of the waveform 110 is zero. Accordingly, the portion 130h of the waveform 130 corresponding to the point 110w and the subsequent points is zero.
  • the second-order derivative of curvature is obtained.
  • the waveform 130 of FIG. At the edge portion, the jerk in the lateral direction of the vehicle 50 changes abruptly, so that the vehicle 50 may slip sideways and the passenger may feel uncomfortable.
  • the waveform 130 changes smoothly in the entire section. More specifically, the waveform 130 includes a start part of the part 130b, a connection part between the part 130b and the part 130c, an end part of the part 130c, a start part of the part 130f, a connection part between the part 130f and the part 130g, and a part. It smoothly changes at the end of 130 g.
  • the traveling track creation device 2 can create a traveling track in which the rate of change in the lateral jerk of the vehicle 50 changes smoothly. That is, the traveling track creation device 2 can create a traveling track on which the vehicle 50 can travel smoothly. Thereby, the traveling track creation device 2 can suppress the occurrence of skidding of the vehicle 50 and can suppress the discomfort of the occupant.
  • the first curve portion 110l, the second curve portion 110m, the third curve portion 110n, and the fourth curve portion 110o are hyperbolic tangent function curves.
  • the present invention is not limited to this.
  • Another example of the first curve portion 110l, the second curve portion 110m, the third curve portion 110n, and the fourth curve portion 110o is a sigmoid function curve.
  • y (tanh (x / 2) +1) / 2 (8)
  • the traveling track creation device 2 uses the first curve portion 110l, the second curve portion 110m, the third curve portion 110n, and the fourth curve portion 110o as sigmoid function curves as well as the hyperbolic tangent function curve.
  • a traveling track in which the rate of change of the jerk in the lateral direction of the vehicle 50 changes smoothly can be created. That is, the traveling track creation device 2 can create a traveling track on which the vehicle 50 can travel smoothly. Thereby, the traveling track creation device 2 can suppress the occurrence of skidding of the vehicle 50 and can suppress the discomfort of the occupant.
  • the configuration described in the above embodiment shows an example of the contents of the present invention, and can be combined with another known technique, and can be combined with other configurations without departing from the gist of the present invention. It is also possible to omit or change the part.
  • 1, 1A, 1B driving support device 2,80 traveling track creation device, 21 position detection unit, 22, 82 storage unit, 23, 81 control unit, 24 display unit, 25 actuator, 26, 71 communication unit, 27 recording medium Reading unit, 41 Map data reading unit, 42 Curvature waveform creation unit, 43 First change unit, 44 Second change unit, 45 Travel track creation unit, 46 Travel track display unit, 47 Actuator control unit, 48 Current location transmission unit, 49 Traveling track receiving unit, 50 vehicles, 60, 61 driving support system, 72 recording medium writing unit, 83 current location receiving unit, 84 traveling track transmitting unit, 90 recording medium.

Landscapes

  • Engineering & Computer Science (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • General Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Human Computer Interaction (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Traffic Control Systems (AREA)

Abstract

車両が道路を道なりに走行する場合の軌道であり、進入直線軌道と、進入直線軌道に引き続く円弧軌道と、円弧軌道に引き続く脱出直線軌道と、を有する基準走行軌道の曲率を表す波形を作成する曲率波形作成部と、波形の2つのエッジである第1エッジ部及び第2エッジ部の各々をランプ状に変更し、波形に第1ランプ状部及び第2ランプ状部を設ける第1変更部と、第1ランプ状部及び第2ランプ状部の各々の両端を曲線に変更し、波形に第1曲線部、第2曲線部、第3曲線部及び第4曲線部を設ける第2変更部と、波形に基づいて、走行軌道を作成する走行軌道作成部と、を備えることを特徴とする。

Description

走行軌道作成装置、方法及びプログラム、並びに、運転支援装置及びシステム
 本発明は、車両が道路を走行する走行軌道を作成する走行軌道作成装置、方法及びプログラム、並びに、運転支援装置及びシステムに関する。
 高速道路や主要幹線道路などのカーブは、カーブに進入する進入直線部と、進入直線部に引き続く進入クロソイド部と、進入クロソイド部に引き続く円弧部と、円弧部に引き続く脱出クロソイド部と、脱出クロソイド部に引き続く脱出直線部と、を有する。道路がこのように構成されていれば、車両は、カーブを高速で滑らかに走行することができるので、車両の横滑りを抑制できるとともに、乗員の不快感を抑制することができる。
 しかしながら、市街地の交差点などは、進入直線部と、進入直線部に引き続く円弧部と、円弧部に引き続く脱出直線部と、だけを有し、進入クロソイド部及び脱出クロソイド部を有しない場合がある。
 図23は、交差点の一例を示す平面図である。この交差点200は、四叉路である。車両300が、図中左側から矢印201に沿って交差点200に進入し、図中上側へ矢印202に沿って交差点200から脱出する場合、車両300は、進入直線部203と、進入直線部203に引き続く円弧部204と、円弧部204に引き続く脱出直線部205と、を通過する。
 関連する技術として、下記の特許文献1には、道路パラメータと、車両の位置情報と、に基づいて、線分、円弧、クロソイド曲線等を用いた仮想的デジタル走行軌道を生成する運転支援システムが開示されている。
 また、下記の特許文献2には、移動体の現在位置の座標を所定時間毎に検出し、検出される座標群に基づき、直線部と、直線部に引き続く非直線部と、非直線部に引き続く直線部と、で構成されている道路の地図を作成する道路地図作成装置が開示されている。
特許第4125569号公報 特許第5749359号公報
 道路が進入直線部と、進入直線部に引き続く円弧部と、円弧部に引き続く脱出直線部と、だけで構成されている場合に、車両が道なりに走行すると、車両は進入直線部と円弧部との接続点及び円弧部と脱出直線部との接続点で滑らかに走行することができないので、車両の横滑りの可能性が大きくなるとともに、乗員の不快感が大きくなる。
 特に、運転者のステアリング操作をアシストし又は運転者に代わってステアリング操作を行う運転支援装置を搭載した車両は、道なりに走行するようにステアリング操作をアシストし又はステアリング操作を行うので、車両の横滑りの可能性が大きくなるとともに、乗員の不快感が大きくなる。
 進入直線部と、進入直線部に引き続く円弧部と、円弧部に引き続く脱出直線部と、だけで構成されている交差点は、信号を有するものが約20万箇所、信号を有しないものが約80万箇所ある。従って、車両の横滑りを抑制するとともに、乗員の不快感を抑制する必要性が高い。
 本発明は、上記に鑑みてなされたものであって、車両が滑らかに走行することができる走行軌道を作成できる走行軌道作成装置、方法及びプログラム、並びに、運転支援装置及びシステムを得ることを目的とする。
 上述した課題を解決し、目的を達成するために、本発明の第1の観点にかかる走行軌道作成装置は、進入直線部と、進入直線部に引き続く円弧部と、円弧部に引き続く脱出直線部と、を有する道路を車両が走行する走行軌道を作成する走行軌道作成装置であって、車両が道路を道なりに走行する場合の軌道であり、進入直線軌道と、進入直線軌道に引き続く円弧軌道と、円弧軌道に引き続く脱出直線軌道と、を有する基準走行軌道の曲率を表す波形を作成する曲率波形作成部と、波形の2つのエッジである第1エッジ部及び第2エッジ部の各々をランプ状に変更し、波形に第1ランプ状部及び第2ランプ状部を設ける第1変更部と、第1ランプ状部及び第2ランプ状部の各々の両端を曲線に変更し、波形に第1曲線部、第2曲線部、第3曲線部及び第4曲線部を設ける第2変更部と、波形に基づいて、走行軌道を作成する走行軌道作成部と、を備えることを特徴とする。
 本発明の第1の観点にかかる走行軌道作成装置において、第1曲線部、第2曲線部、第3曲線部及び第4曲線部は、2次曲線であることとしても良い。
 また、本発明の第1の観点にかかる走行軌道作成装置において、第1曲線部、第2曲線部、第3曲線部及び第4曲線部は、双曲線正接関数曲線又はシグモイド関数曲線であることとしても良い。
 また、本発明の第1の観点にかかる走行軌道作成装置において、第2変更部は、第1曲線部と第2曲線部とを直結し、第3曲線部と第4曲線部とを直結しても良い。
 また、本発明の第1の観点にかかる走行軌道作成装置において、第1変更部は、第1ランプ状部及び第2ランプ状部の中点が第1エッジ部及び第2エッジ部に夫々重なるように、第1ランプ状部及び第2ランプ状部を設けることとしても良い。
 また、本発明の第1の観点にかかる運転支援装置は、本発明の第1の観点にかかる走行軌道作成装置と、画像を表示する表示部と、走行軌道を表示部に表示させる走行軌道表示部と、を備えることを特徴とする。
 また、本発明の第2の観点にかかる運転支援装置は、本発明の第1の観点にかかる走行軌道作成装置と、車両のステアリングコラムを回転させるアクチュエータと、車両が走行軌道を走行するように、アクチュエータを動作させることでステアリングコラムを回転させるアクチュエータ制御部と、を備えることを特徴とする。
 本発明の第1の観点にかかる走行軌道作成装置は、走行軌道を記録媒体に書き込む記録媒体書込部を更に備えることとしても良い。
 また、本発明の第3の観点にかかる運転支援装置は、上記走行軌道作成装置によって記録媒体に記録された走行軌道を読み取る記録媒体読取部と、画像を表示する表示部と、走行軌道を表示部に表示させる走行軌道表示部と、を備えることを特徴とする。
 また、本発明の第4の観点にかかる運転支援装置は、上記走行軌道作成装置によって記録媒体に記録された走行軌道を読み取る記録媒体読取部と、車両のステアリングコラムを回転させるアクチュエータと、車両が走行軌道を走行するように、アクチュエータを動作させることでステアリングコラムを回転させるアクチュエータ制御部と、を備えることを特徴とする。
 また、本発明の第1の観点にかかる運転支援システムは、車両に搭載された運転支援装置と、運転支援装置と通信する走行軌道作成装置と、を備える運転支援システムであって、走行軌道作成装置は、車両の現在地を運転支援装置から受信する現在地受信部と、車両が道路を道なりに走行する場合の軌道であり、進入直線軌道と、進入直線軌道に引き続く円弧軌道と、円弧軌道に引き続く脱出直線軌道と、を有する基準走行軌道の曲率を表す波形を作成する曲率波形作成部と、波形の2つのエッジである第1エッジ部及び第2エッジ部の各々をランプ状に変更し、波形に第1ランプ状部及び第2ランプ状部を設ける第1変更部と、第1ランプ状部及び第2ランプ状部の各々の両端を曲線に変更し、波形に第1曲線部、第2曲線部、第3曲線部及び第4曲線部を設ける第2変更部と、波形に基づいて、走行軌道を作成する走行軌道作成部と、走行軌道を運転支援装置に送信する走行軌道送信部と、を備え、運転支援装置は、画像を表示する表示部と、走行軌道を走行軌道作成装置から受信する走行軌道受信部と、走行軌道を表示部に表示させる走行軌道表示部と、を備えることを特徴とする。
 また、本発明の第2の観点にかかる運転支援システムは、車両に搭載された運転支援装置と、運転支援装置と通信する走行軌道作成装置と、を備える運転支援システムであって、走行軌道作成装置は、車両の現在地を運転支援装置から受信する現在地受信部と、車両が道路を道なりに走行する場合の軌道であり、進入直線軌道と、進入直線軌道に引き続く円弧軌道と、円弧軌道に引き続く脱出直線軌道と、を有する基準走行軌道の曲率を表す波形を作成する曲率波形作成部と、波形の2つのエッジである第1エッジ部及び第2エッジ部の各々をランプ状に変更し、波形に第1ランプ状部及び第2ランプ状部を設ける第1変更部と、第1ランプ状部及び第2ランプ状部の各々の両端を曲線に変更し、波形に第1曲線部、第2曲線部、第3曲線部及び第4曲線部を設ける第2変更部と、波形に基づいて、走行軌道を作成する走行軌道作成部と、走行軌道を運転支援装置に送信する走行軌道送信部と、を備え、運転支援装置は、車両のステアリングコラムを回転させるアクチュエータと、車両が走行軌道を走行するように、アクチュエータを動作させることでステアリングコラムを回転させるアクチュエータ制御部と、を備えることを特徴とする。
 また、本発明にかかる走行軌道作成方法は、進入直線部と、進入直線部に引き続く円弧部と、円弧部に引き続く脱出直線部と、を有する道路を車両が走行する走行軌道を作成する走行軌道作成方法であって、車両が道路を道なりに走行する場合の軌道であり、進入直線軌道と、進入直線軌道に引き続く円弧軌道と、円弧軌道に引き続く脱出直線軌道と、を有する基準走行軌道の曲率を表す波形を作成する曲率波形作成ステップと、波形の2つのエッジである第1エッジ部及び第2エッジ部の各々をランプ状に変更し、波形に第1ランプ状部及び第2ランプ状部を設ける第1変更ステップと、第1ランプ状部及び第2ランプ状部の各々の両端を曲線に変更し、波形に第1曲線部、第2曲線部、第3曲線部及び第4曲線部を設ける第2変更ステップと、波形に基づいて、走行軌道を作成する走行軌道作成ステップと、を備えることを特徴とする。
 また、本発明にかかる走行軌道作成プログラムは、進入直線部と、進入直線部に引き続く円弧部と、円弧部に引き続く脱出直線部と、を有する道路を車両が走行する走行軌道を作成するためにコンピュータが実行する走行軌道作成プログラムであって、車両が道路を道なりに走行する場合の軌道であり、進入直線軌道と、進入直線軌道に引き続く円弧軌道と、円弧軌道に引き続く脱出直線軌道と、を有する基準走行軌道の曲率を表す波形を作成する曲率波形作成ステップと、波形の2つのエッジである第1エッジ部及び第2エッジ部の各々をランプ状に変更し、波形に第1ランプ状部及び第2ランプ状部を設ける第1変更ステップと、第1ランプ状部及び第2ランプ状部の各々の両端を曲線に変更し、波形に第1曲線部、第2曲線部、第3曲線部及び第4曲線部を設ける第2変更ステップと、波形に基づいて、走行軌道を作成する走行軌道作成ステップと、を備えることを特徴とする。
 本発明によれば、車両が滑らかに走行することができる走行軌道を作成できるという効果を奏する。
図1は、実施の形態1にかかる運転支援装置の構成を示す図である。 図2は、実施の形態1にかかる走行軌道作成装置の機能ブロックを示す図である。 図3は、実施の形態1にかかる運転支援装置の処理を示すフローチャートである。 図4は、実施の形態1にかかる地図データで表される地図に含まれている道路の一例を示す平面図である。 図5は、実施の形態1にかかる道路の曲率を表す波形の一例を示す図である。 図6は、実施の形態1にかかる運転支援装置で作成される波形の一例を示す図である。 図7は、実施の形態1にかかる運転支援装置で作成される波形の一例を示す図である。 図8は、実施の形態1にかかる運転支援装置で作成される波形の一例の一部拡大図である。 図9は、実施の形態1にかかる運転支援装置で作成される走行軌道の一例を示す図である。 図10は、実施の形態1にかかる走行軌道の曲率の2階微分の波形を示す図である。 図11は、実施の形態2にかかる運転支援システムの構成を示す図である。 図12は、実施の形態2にかかる運転支援装置の機能ブロックを示す図である。 図13は、実施の形態2にかかる走行軌道作成装置の機能ブロックを示す図である。 図14は、実施の形態2にかかる運転支援システムの動作を示すシーケンス図である。 図15は、実施の形態3にかかる運転支援システムの構成を示す図である。 図16は、実施の形態4にかかる運転支援装置の処理を示すフローチャートである。 図17は、実施の形態4にかかる運転支援装置で作成される波形の一例を示す図である。 図18は、実施の形態4にかかる運転支援装置で作成される波形の一例を示す図である。 図19は、実施の形態5にかかる運転支援装置で作成される波形の一例を示す図である。 図20は、実施の形態5にかかる運転支援装置で作成される波形の一例を示す図である。 図21は、実施の形態5にかかる運転支援装置で作成される波形の一例の一部拡大図である。 図22は、実施の形態5にかかる走行軌道の曲率の2階微分の波形の一部拡大図である。 図23は、交差点の一例を示す平面図である。
 以下に、本発明の実施の形態にかかる走行軌道作成装置、方法及びプログラム、並びに、運転支援装置及びシステムを図面に基づいて詳細に説明する。なお、この実施の形態によりこの発明が限定されるものではない。
実施の形態1.
 図1は、実施の形態1にかかる運転支援装置の構成を示す図である。この運転支援装置1は、車両50に搭載されている。
 運転支援装置1は、走行軌道作成装置2と、表示部24と、アクチュエータ25と、を備える。走行軌道作成装置2は、位置検出部21と、記憶部22と、制御部23と、を備える。
 位置検出部21は、GPS受信機21aと、ジャイロスコープ21bと、距離センサ21cと、地磁気センサ21dと、を備える。
 GPS受信機21aは、GPS(Global Positioning System)用の人工衛星からの電波を受信し、車両50の位置、方位(進行方向)、速度、加速度等を検出して制御部23に出力する。
 ジャイロスコープ21bは、車両50の角速度(方位変化量)を検出するためのセンサであり、車両50に加わる回転運動の角速度に応じた検出信号を制御部23に出力する。
 距離センサ21cは、車両50の前後方向の加速度等に基づいて、車両50が走行した距離を検出して制御部23に出力する。
 地磁気センサ21dは、半導体を用いた方位センサであり、地球に生じている南北の地磁気に基づいて、方位(進行方向)を検出して制御部23に出力する。
 記憶部22は、地図データ22aと、自動運転設定フラグ22bと、を記憶する。記憶部22は、SSD(Solid State Drive)又はHDD(Hard Disk Drive)が例示される。
 地図データ22aは、進入直線部と、進入直線部に引き続く円弧部と、円弧部に引き続く脱出直線部と、だけを有し、進入クロソイド部及び脱出クロソイド部を有しないカーブ又は交差点の地図データを含む。
 自動運転設定フラグ22bは、運転支援装置1で車両50の自動運転を行う場合には「1」が予め設定され、運転支援装置1で車両50の自動運転を行わない場合には「0」が予め設定される。
 制御部23は、CPU(Central Processing Unit)23aと、ROM(Read Only Memory)23bと、RAM(Random Access Memory)23cと、を備える。CPU23a、ROM23b及びRAM23cは、バスBを介して接続されている。
 CPU23aは、RAM23cを作業領域として使用しながら、ROM23bに記憶されているプログラムを実行する。なお、プログラムは、記憶部22に記憶されていても良い。
 表示部24は、制御部23から出力されるデータに基づいて、地図及び車両50が走行する走行軌道の画像を表示する。表示部24は、液晶表示装置又は有機EL(Electro Luminescence)表示装置が例示される。
 アクチュエータ25は、車両50のステアリングコラム51に接続されており、運転支援装置1が自動運転を行う場合には、制御部23から出力される制御信号に基づいて、ステアリングコラム51を回転させる。これにより、車両50の方位(進行方向)が変化する。アクチュエータ25は、モータ又は油圧ポンプが例示される。
 図2は、実施の形態1にかかる走行軌道作成装置の機能ブロックを示す図である。CPU23aは、ROM23bに記憶されたプログラムを実行する。これにより、地図データ読出部41、曲率波形作成部42、第1変更部43、第2変更部44、走行軌道作成部45、走行軌道表示部46及びアクチュエータ制御部47が実現される。
 地図データ読出部41は、記憶部22から地図データ22aを読み出す。
 曲率波形作成部42は、車両50が道路を道なりに走行する場合の軌道であり、進入直線軌道と、進入直線軌道に引き続く円弧軌道と、円弧軌道に引き続く脱出直線軌道と、を有する基準走行軌道の曲率を表す波形を作成する。
 第1変更部43は、波形の2つのエッジである第1エッジ部及び第2エッジ部の各々をランプ状に変更し、波形に第1ランプ状部及び第2ランプ状部を設ける。
 第2変更部44は、第1ランプ状部及び第2ランプ状部の各々の両端を曲線に変更し、波形に第1曲線部、第2曲線部、第3曲線部及び第4曲線部を設ける。
 走行軌道作成部45は、波形に基づいて、走行軌道を作成する。
 走行軌道表示部46は、走行軌道を表示部24に表示させる。
 アクチュエータ制御部47は、車両50が走行軌道を走行するように、アクチュエータ25を動作させることでステアリングコラム51を回転させる。
 図3は、実施の形態1にかかる運転支援装置の処理を示すフローチャートである。運転支援装置1は、車両50とカーブ又は交差点との間の距離が予め定められた距離になったら、図3に示す処理を開始する。
 地図データ読出部41は、ステップS100において、地図データ22aを記憶部22から読み出す。
 図4は、実施の形態1にかかる地図データで表される地図に含まれている道路の一例を示す平面図である。図4において、横軸方向をX軸方向とし、縦軸方向をY軸方向とする。この道路100は、進入直線部101と、進入直線部101に引き続く円弧部102と、円弧部102に引き続く脱出直線部103と、を有する。なお、図4では、一方の車線だけを図示し、対向車線の図示を省略している。
 地図データ22aには、基準走行軌道104が含まれている。基準走行軌道104は、車両50が道路100を道なりに走行する場合の軌道であり、道路100の中心線が例示される。
 基準走行軌道104は、進入直線部101内では進入直線軌道104aを有し、円弧部102内では進入直線軌道104aに引き続く円弧軌道104bを有し、脱出直線部103内では円弧軌道104bに引き続く脱出直線軌道104cを有する。円弧軌道104bは、地点105を中心とする半径Rの円弧である。
 進入直線軌道104aと円弧軌道104bとは、進入直線部101と円弧部102との境界に位置する地点104dで接続する。円弧軌道104bと脱出直線軌道104cとは、円弧部102と脱出直線部103との境界に位置する地点104eで接続する。
 再び図3を参照すると、曲率波形作成部42は、ステップS102において、基準走行軌道104の曲率を表す波形を作成する。
 図5は、実施の形態1にかかる道路の曲率を表す波形の一例を示す図である。図5において、横軸方向をX軸方向とし、縦軸方向を曲率とする。進入直線軌道104aでの曲率は、0である。円弧軌道104bでの曲率は、1/Rである。脱出直線軌道104cでの曲率は、0である。
 従って、曲率波形作成部42は、進入直線軌道104aに対応し、曲率が0である第1部分110aと、円弧軌道104bに対応し、曲率が1/Rである第2部分110bと、脱出直線軌道104cに対応し、曲率が0である第3部分110cと、を有する波形110を作成する。
 なお、波形110は、RAM23c内で作成されれば良く、表示部24に表示される必要はない。
 第1部分110aと第2部分110bとの間は、第1エッジ部110dとなり、第2部分110bと第3部分110cとの間は、第2エッジ部110eとなる。
 もし、車両50が基準走行軌道104を走行する場合には、車両50のステアリングは、地点104d及び地点104eで急操作される。
 車両50の横方向の加速度は、曲率に比例する。横方向とは、車両50の進行方向に直交する方向を言う。つまり、基準走行軌道104の曲率を表す波形110は、基準走行軌道104を走行する車両50の横方向の加速度を表す波形でもある。従って、第1エッジ部110d及び第2エッジ部110eでは、車両50の横方向の加速度が急激に変化し、車両50の横滑りの可能性が大きくなるとともに、乗員の不快感が大きくなる。
 再び図3を参照すると、第1変更部43は、ステップS104において、波形110の第1エッジ部110d及び第2エッジ部110eをランプ状に変更し、第1ランプ状部110f及び第2ランプ状部110gを設ける。
 図6は、実施の形態1にかかる運転支援装置で作成される波形の一例を示す図である。第1変更部43は、波形110の第1エッジ部110dをランプ状に変更し、第1ランプ状部110fを設ける。実施の形態1では、第1変更部43は、第1エッジ部110dの下端を始点110hとする第1ランプ状部110fを設ける。従って、第1ランプ状部110fの終点110iは、第1エッジ部110dよりも進行方向先側になる。
 また、第1変更部43は、波形110の第2エッジ部110eをランプ状に変更し、第2ランプ状部110gを設ける。実施の形態1では、第1変更部43は、第2エッジ部110eの下端を終点110jとする第2ランプ状部110gを設ける。従って、第2ランプ状部110gの始点110kは、第2エッジ部110eよりも進行方向手前側になる。
 再び図3を参照すると、第2変更部44は、ステップS106において、第1ランプ状部110f及び第2ランプ状部110gの両端を曲線に変更し、第1曲線部110l、第2曲線部110m、第3曲線部110n及び第4曲線部110oを設ける。
 図7は、実施の形態1にかかる運転支援装置で作成される波形の一例を示す図である。第2変更部44は、第1ランプ状部110fの始点110h側の端部を第1曲線部110lに変更する。実施の形態1では、第2変更部44は、進行方向手前側の点110pでの接線が第1部分110aと一致し、進行方向先側の点110qでの接線が第1ランプ状部110fと一致する2次曲線である第1曲線部110lを設ける。従って、第1曲線部110lは、第1エッジ部110dを跨ぐことになる。
 第2変更部44は、第1ランプ状部110fの終点110i側の端部を第2曲線部110mに変更する。実施の形態1では、第2変更部44は、進行方向手前側の点110rでの接線が第1ランプ状部110fと一致し、進行方向先側の点110sでの接線が第2部分110bと一致する2次曲線である第2曲線部110mを設ける。
 第2変更部44は、第2ランプ状部110gの始点110k側の端部を第3曲線部110nに変更する。実施の形態1では、第2変更部44は、進行方向手前側の点110tでの接線が第2部分110bと一致し、進行方向先側の点110uでの接線が第2ランプ状部110gと一致する2次曲線である第3曲線部110nを設ける。
 第2変更部44は、第2ランプ状部110gの終点110j側の端部を第4曲線部110oに変更する。実施の形態1では、第2変更部44は、進行方向手前側の点110vでの接線が第2ランプ状部110gと一致し、進行方向先側の点110wでの接線が第3部分110cと一致する2次曲線である第4曲線部110oを設ける。従って、第4曲線部110oは、第2エッジ部110eを跨ぐことになる。
 実施の形態1では、点110pから点110sまで及び点110tから点110wまでの夫々を「ロールジャーク曲線」と称する。
 図8は、実施の形態1にかかる運転支援装置で作成される波形の一例の一部拡大図である。図8は、図7の第1ランプ状部110fの近傍の拡大図である。
 第2変更部44は、第1ランプ状部110fの始点110h側の端部を第1曲線部110lに変更する。実施の形態1では、第2変更部44は、進行方向手前側の点110pでの接線が第1部分110aと一致し、進行方向先側の点110qでの接線が第1ランプ状部110fと一致する2次曲線である第1曲線部110lを設ける。従って、第1曲線部110lは、第1エッジ部110dを跨ぐことになる。
 第2変更部44は、第1ランプ状部110fの終点110i側の端部を第2曲線部110mに変更する。実施の形態1では、第2変更部44は、進行方向手前側の点110rでの接線が第1ランプ状部110fと一致し、進行方向先側の点110sでの接線が第2部分110bと一致する2次曲線である第2曲線部110mを設ける。
 なお、実施の形態1では、第1曲線部110l、第2曲線部110m、第3曲線部110n及び第4曲線部110oを2次曲線としたが、これに限定されない。第1曲線部110l、第2曲線部110m、第3曲線部110n及び第4曲線部110oの他の例は、3次以上の高次曲線又は指数曲線が例示される。
 再び図3を参照すると、走行軌道作成部45は、ステップS108において、波形110に基づいて、走行軌道120を作成する。
 図9は、実施の形態1にかかる運転支援装置で作成される走行軌道の一例を示す図である。走行軌道作成部45は、波形110を一定間隔で走査し、各走査点での曲率に基づく点を道路100上にプロットすることにより、走行軌道120を作成することができる。
 波形110の原点Oから点110pまでは、変更がされていない。従って、走行軌道作成部45は、点110pとX座標が同じ地点120aまでは、進入直線軌道104aに沿った直線の軌道120Aを作成する。
 波形110の点110pから点110qまでは、2次曲線である第1曲線部110lに変更されている。従って、走行軌道作成部45は、点110pとX座標が同じ地点120aから点110qとX座標が同じ地点120bまでは、曲率が2次曲線である軌道120Bを作成する。
 なお、地点120aは、進入直線部101と円弧部102との境界よりも進行方向手前側である。従って、走行軌道120は、基準走行軌道104に比べて、進行方向手前側から曲がり始める。
 波形110の点110qから点110rまでは、第1ランプ状部110fに変更されている。従って、走行軌道作成部45は、点110qとX座標が同じ地点120bから点110rとX座標が同じ地点120cまでは、曲率がランプ状である軌道120Cを作成する。なお、曲率がランプ状である曲線は、クロソイド曲線である。従って、軌道120Cは、クロソイド曲線になる。
 波形110の点110rから点110sまでは、2次曲線である第2曲線部110mに変更されている。従って、走行軌道作成部45は、点110rとX座標が同じ地点120cから点110sとX座標が同じ地点120dまでは、曲率が2次曲線である軌道120Dを作成する。
 波形110の点110sから点110tまでは、変更がされていない。従って、走行軌道作成部45は、点110sとX座標が同じ地点120dから点110tとX座標が同じ地点120eまでは、円弧軌道104bと同様に、円弧の軌道120Eを作成する。なお、軌道120Bが基準走行軌道104に比べて進行方向手前側から曲がり始めているので、軌道120Eの中心の地点121は、円弧軌道104bの中心の地点105よりも道路100から離れた場所に位置する。
 波形110の点110tから点110uまでは、2次曲線である第3曲線部110nに変更されている。従って、走行軌道作成部45は、点110tとX座標が同じ地点120eから点110uとX座標が同じ地点120fまでは、曲率が2次曲線である軌道120Fを作成する。
 波形110の点110uから点110vまでは、第2ランプ状部110gに変更されている。従って、走行軌道作成部45は、点110uとX座標が同じ地点120fから点110vとX座標が同じ地点120gまでは、曲率がランプ状である軌道120Gを作成する。なお、曲率がランプ状である曲線は、クロソイド曲線である。従って、軌道120Gは、クロソイド曲線になる。
 波形110の点110vから点110wまでは、2次曲線である第4曲線部110oに変更されている。従って、走行軌道作成部45は、点110vとX座標が同じ地点120gから点110wとX座標が同じ地点120hまでは、曲率が2次曲線である軌道120Hを作成する。
 なお、地点120hは、円弧部102と脱出直線部103との接続部よりも進行方向先側である。従って、走行軌道120は、基準走行軌道104よりも進行方向先側まで曲がり続ける。
 波形110の点110wから進行方向先側は、変更がされていない。従って、走行軌道作成部45は、点110wとX座標が同じ地点120hから進行方向先側は、脱出直線軌道104cに沿った直線の軌道120Iを作成する。
 走行軌道120は、軌道120A,120B,120C,120D,120E,120F,120G,120H及び120Iで構成される。
 実施の形態1では、地点120aから地点120dまで及び地点120eから地点120hまでの夫々を「ロールジャーク走行軌道」と称する。
 車両50の横方向の加速度は、曲率に正比例する。つまり、走行軌道120の曲率を表す波形110は、走行軌道120を走行する車両50の横方向の加速度を表す波形でもある。波形110は、点110pから点110sまで滑らかに増加し、点110tから点110wまで滑らかに減少する。従って、走行軌道120を走行する車両50の横方向の加速度は、滑らかに変化する。つまり、運転支援装置1は、車両50が滑らかに走行できる走行軌道120を作成することができる。これにより、運転支援装置1は、車両50の横滑りの可能性を抑制できるとともに、乗員の不快感を抑制することができる。
 再び図3を参照すると、走行軌道表示部46は、ステップS110において、走行軌道120を地図に重ねて表示部24に表示する。ユーザは、車両50の自動運転を行わない場合、車両50が表示部24に表示された走行軌道120を走行するように、ステアリングを操作する。これにより、車両50の横方向の加速度が滑らかに変化する。従って、車両50の横滑りの発生を抑制できるとともに、乗員の不快感を抑制することができる。
 アクチュエータ制御部47は、ステップS112において、自動運転設定フラグ22bが「1」であるか否かを判定する。アクチュエータ制御部47は、自動運転設定フラグ22bが「1」であると判定したら(Yes)、処理をステップS114に進め、自動運転設定フラグ22bが「0」であると判定したら(No)、処理を終了する。
 アクチュエータ制御部47は、ステップS114において、車両50が走行軌道120を走行するように、アクチュエータ25を動作させることでステアリングコラム51を回転させて、処理を終了する。これにより、車両50の横方向の加速度は、滑らかに変化する。つまり、運転支援装置1は、車両50を滑らかに走行させることができる。従って、運転支援装置1は、車両50の横滑りの可能性を抑制できるとともに、乗員の不快感を抑制することができる。
 図10は、実施の形態1にかかる走行軌道の曲率の2階微分の波形を示す図である。走行軌道120の曲率は、車両50の横方向の加速度に正比例する。走行軌道120の曲率の1階微分は、車両50の横方向の加加速度(躍度、ジャーク(jerk))に正比例する。走行軌道120の曲率の2階微分は、車両50の横方向の加加速度の変化率に正比例する。
 図10に示すように、曲率の波形110の原点Oから点110pまでは、0である。従って、走行軌道120の曲率の2階微分の波形130の、原点Oから点110pに対応する箇所までの部分130aは、0となる。
 波形110の点110pから点110qまでは、2次曲線である。従って、波形130の、点110pに対応する箇所から点110qに対応する箇所までの部分130bは、正の定数となる。
 波形110の点110qから点110rまでは、ランプ状である。従って、波形130の、点110qに対応する箇所から点110rに対応する箇所までの部分130cは、0となる。
 波形110の点110rから点110sまでは、2次曲線である。従って、波形130の、点110rに対応する箇所から点110sに対応する箇所までの部分130dは、負の定数となる。
 波形110の点110sから点110tまでは、正の定数である。従って、波形130の、点110sに対応する箇所から点110tに対応する箇所までの部分130eは、0となる。
 波形110の点110tから点110uまでは、2次曲線である。従って、波形130の、点110tに対応する箇所から点110uに対応する箇所までの部分130fは、負の定数となる。
 波形110の点110uから点110vまでは、ランプ状である。従って、波形130の、点110uに対応する箇所から点110vに対応する箇所までの部分130gは、0となる。
 波形110の点110vから点110wまでは、2次曲線である。従って、波形130の、点110vに対応する箇所から点110wに対応する箇所までの部分130hは、正の定数となる。
 波形110の点110w以降は、0である。従って、波形130の、点110wに対応する箇所以降の部分130iは、0となる。
 以上説明したように、運転支援装置1は、車両50の横方向の加速度が滑らかに変化する走行軌道120を作成することができる。つまり、運転支援装置1は、車両50が滑らかに走行できる走行軌道120を作成することができる。これにより、運転支援装置1は、車両50の横滑りの発生を抑制できるとともに、乗員の不快感を抑制することができる。
 また、運転支援装置1は、地図データ22a内の一条道路(ポリライン)である基準走行軌道104から、走行軌道120を作成することができる。
 また、運転支援装置1は、車両50が走行軌道120を走行するように、アクチュエータ25を動作させて、ステアリングコラム51を回転させる。従来の運転支援装置では、車両50の横滑りの可能性を抑制するとともに、乗員の不快感を抑制するために、車両50の走行状態を検出して制御量を調整するフィードバック制御を行う必要があった。一方、運転支援装置1は、車両50が走行軌道120を走行するようにフィードフォワード制御を行うことができるので、構成を簡易にでき、安価に製造できる。
実施の形態2.
 図11は、実施の形態2にかかる運転支援システムの構成を示す図である。なお、実施の形態1と同様の構成要素については、同一の符号を付して、説明を省略する。
 この運転支援システム60は、車両50に搭載された運転支援装置1Aと、サーバ70と、を備える。
 運転支援装置1Aは、実施の形態1にかかる運転支援装置1の構成要素である位置検出部21、記憶部22、制御部23、表示部24及びアクチュエータ25に加えて、サーバ70と無線通信を行う通信部26を更に備える。無線通信は、W-CDMA(Wideband Code Division Multiple Access)又はLTE(Long Term Evolution)が例示される。
 サーバ70は、運転支援装置1Aと無線通信を行う通信部71と、走行軌道作成装置80と、を備える。走行軌道作成装置80は、制御部81と、記憶部82と、を備える。
 制御部81は、CPU81aと、ROM81bと、RAM81cと、を備える。CPU81a、ROM81b及びRAM81cは、バスB1を介して接続されている。
 CPU81aは、RAM81cを作業領域として使用しながら、ROM82bに記憶されているプログラムを実行する。なお、プログラムは、記憶部82に記憶されていても良い。
 記憶部82は、地図データ82aを記憶する。記憶部82は、SSD又はHDDが例示される。
 図12は、実施の形態2にかかる運転支援装置の機能ブロックを示す図である。CPU23aは、ROM23bに記憶されたプログラムを実行する。これにより、走行軌道表示部46、アクチュエータ制御部47、現在地送信部48及び走行軌道受信部48が実現される。
 現在地送信部48は、車両50の現在地をサーバ70に送信する。
 走行軌道受信部49は、走行軌道をサーバ70から受信する。
 図13は、実施の形態2にかかる走行軌道作成装置の機能ブロックを示す図である。CPU81aは、ROM81bに記憶されたプログラムを実行する。これにより、地図データ読出部41、曲率波形作成部42、第1変更部43、第2変更部44、走行軌道作成部45、現在地受信部83及び走行軌道送信部84が実現される。
 現在地受信部83は、車両50の現在地を運転支援装置1Aから受信する。
 走行軌道送信部84は、走行軌道を運転支援装置1Aに送信する。
 図14は、実施の形態2にかかる運転支援システムの動作を示すシーケンス図である。運転支援装置1Aは、車両50とカーブ又は交差点との間の距離が予め定められた距離になったら、図14に示す処理を開始する。
 運転支援装置1Aの現在地送信部48は、ステップS200において、車両50の現在地を表すデータをサーバ70に送信する。サーバ70の現在地受信部83は、車両50の現在地を表すデータを運転支援装置1Aから受信する。
 サーバ70の地図データ読出部41、曲率波形作成部42、第1変更部43、第2変更部44及び走行軌道作成部45は、ステップS202において、車両50の横方向の加速度が滑らかに変化する走行軌道を作成する。
 なお、ステップS202の内容は、実施の形態1の図3のフローチャートで示したステップS100からステップS108と同様である。
 サーバ70の走行軌道送信部84は、ステップS204において、走行軌道を運転支援装置1Aに送信する。運転支援装置1Aの走行軌道受信部49は、走行軌道をサーバ70から受信する。
 運転支援装置1Aの走行軌道表示部46は、ステップS206において、走行軌道を地図に重ねて表示部24に表示する。また、運転支援装置1Aのアクチュエータ制御部47は、自動運転設定フラグ22bが「1」であると判定したら、ステップS206において、車両50が走行軌道を走行するように、アクチュエータ25を動作させることでステアリングコラム51を回転させる。
 なお、ステップS206の内容は、実施の形態1の図3のフローチャートで示したステップS110からステップS114と同様である。
 運転支援システム60は、サーバ70側で走行軌道を作成することができる。これにより、車両50に搭載された運転支援装置1A側で走行軌道を作成する必要をなくすことができ、運転支援装置1AのCPU23aの処理負荷を低減することができる。
 車両50に搭載されるCPU23aは、実装上の要請又は消費電力抑制の要請から、処理能力が低い場合がある。しかしながら、運転支援システム60は、サーバ70側で走行軌道を作成することができる。従って、運転支援システム60は、CPU23aの処理能力が低い場合であっても、車両50が滑らかに走行できる走行軌道を作成することができる。これにより、運転支援システム60は、車両50の横滑りの可能性を抑制できるとともに、乗員の不快感を抑制することができる。
実施の形態3.
 図15は、実施の形態3にかかる運転支援システムの構成を示す図である。なお、実施の形態1又は実施の形態2と同様の構成要素については、同一の符号を付して、説明を省略する。
 この運転支援システム61は、車両50に搭載された運転支援装置1Bと、サーバ70Aと、を備える。
 運転支援装置1Bは、実施の形態1にかかる運転支援装置1の構成要素である位置検出部21、記憶部22、制御部23、表示部24及びアクチュエータ25に加えて、記録媒体90に記録されたデータを読み取る記録媒体読取部27を更に備える。
 サーバ70Aは、記録媒体90にデータを書き込む記録媒体書込部72と、走行軌道作成装置80と、を備える。
 記録媒体90は、SDカード(登録商標)、USB(Universal Serial Bus)メモリ又はDVD(Digital Versatile Disc)が例示される。
 走行軌道作成装置80は、日本全国のカーブ又は交差点毎に、車両が滑らかに走行できる走行軌道を作成し、記録媒体90に記録する。
 車両50のユーザは、記録媒体90を車両50に持ち込んで、運転支援装置1Bの記録媒体読取部27に挿入する。なお、運転支援装置1Bは、記録媒体90に記録された走行軌道を記憶部22にインストール又はコピーしても良い。これにより、ユーザは、記録媒体90を取り外すことができる。
 運転支援装置1Bは、車両50とカーブ又は交差点との間の距離が予め定められた距離になったら、走行軌道を記録媒体90又は記憶部22から読み取って、走行軌道を地図に重ねて表示部24に表示する。また、運転支援装置1Bは、自動運転設定フラグ22bが「1」であると判定したら、車両50が走行軌道を走行するように、アクチュエータ25を動作させることでステアリングコラム51を回転させる。
 運転支援システム61は、サーバ70A側で走行軌道を作成することができる。これにより、車両50に搭載された運転支援装置1B側で走行軌道を作成する必要をなくすことができ、運転支援装置1BのCPU23aの処理負荷を低減することができる。
 また、運転支援システム61は、実施の形態2にかかる運転支援システム1Aと比較して、無線通信を不要にすることができる。これにより、運転支援システム61は、システムの製造コストを低減できるとともに、通信費用つまりランニングコストを低減することができる。
実施の形態4.
 車両50の旋回角速度(ヨー角速度)rは、次の式(1)で表される。
  r=(V/l)δ ・・・(1)
 ここで、Vは車両50の速度であり、lは車両50のホイールベースであり、δは車両50の実舵角である。
 また、車両50の旋回半径ρは、次の式(2)で表される。
  ρ=l/δ ・・・(2)
 従って、車両50の旋回角速度rは、次の式(3)で表される。
  r=V/ρ ・・・(3)
 道路100の円弧部102では、1/ρは1/Rつまり曲率である。従って、車両50の旋回角度aは、式(3)を積分した次の式(4)で表される。
  a=V/R・t ・・・(4)
 従って、図5で示した基準走行軌道104の曲率の波形110とX軸とで定まる領域の面積Aは、車両50が基準走行軌道104を走行する場合の旋回角度を表す。
 同様に、図7で示した走行軌道120の曲率の波形110とX軸とで定まる領域の面積Bは、車両50が走行軌道120を走行する場合の旋回角度を表す。
 ところで、図6を参照すると、第1ランプ状部110fの終点110iは、第1エッジ部110dよりも進行方向先側にある。また、第2ランプ状部110gの始点110kは、第2エッジ部110eよりも進行方向手前側にある。
 従って、図7で示した走行軌道120の曲率の波形110とX軸とで定まる領域の面積、つまり車両50が走行軌道120を走行する場合の旋回角度は、図5で示した基準走行軌道104の曲率の波形110とX軸とで定まる領域の面積、つまり車両50が基準走行軌道104を走行する場合の旋回角度よりも小さくなる。
 つまり、車両50が走行軌道120を走行する場合には、車両50が基準走行軌道104を走行する場合よりも旋回角度が小さくなり、車両50が道路100の脱出直線部103の路肩に寄ってしまい、車両50の安全性が確保されない可能性がある。
 実施の形態4では、上記に鑑み、車両50が道路100の脱出直線部103の路肩に寄ってしまうことを抑制し、車両50の安全性を確保する。
 実施の形態4にかかる走行軌道作成装置の機能ブロックは、実施の形態1にかかる図2で示す走行軌道作成装置2と同様であるので、図示を省略する。
 図16は、実施の形態4にかかる運転支援装置の処理を示すフローチャートである。図16に示すフローチャートは、実施の形態1にかかる図3に示したフローチャートのステップS104に代えて、ステップS104aを有する。
 図16に示すフローチャートのステップS100及びS102は、実施の形態1にかかる図3に示したフローチャートのステップS100及びS102と同じであるので、説明を省略する。
 第1変更部43は、ステップS104aにおいて、波形110の第1エッジ部110d及び第2エッジ部110eを第1ランプ状部110f及び第2ランプ状部110gに夫々変更し、第1ランプ状部110fの中点110xが第1エッジ部110dに重なり、第2ランプ状部110gの中点110yが第2エッジ部110eに重なるように、第1ランプ状部110f及び第2ランプ状部110gを設ける。
 図17は、実施の形態4にかかる運転支援装置で作成される波形の一例を示す図である。第1変更部43は、波形110の第1エッジ部110dをランプ状に変更し、第1ランプ状部110fを設ける。実施の形態4では、第1変更部43は、第1ランプ状部110fの中点110xが第1エッジ部110dに重なるように、第1ランプ状部110fを設ける。
 また、第1変更部43は、波形110の第2エッジ部110eをランプ状に変更し、第2ランプ状部110gを設ける。実施の形態4では、第1変更部43は、第2ランプ状部110gの中点110yが第2エッジ部110eに重なるように、第2ランプ状部110gを設ける。
 再び図16を参照すると、第2変更部44は、ステップS106において、第1ランプ状部110f及び第2ランプ状部110gの両端を曲線に変更し、第1曲線部110l、第2曲線部110m、第3曲線部110n及び第4曲線部110oを設ける。
 図18は、実施の形態4にかかる運転支援装置で作成される波形の一例を示す図である。第2変更部44は、第1ランプ状部110fの始点110h側の端部を第1曲線部110lに変更する。実施の形態4では、第2変更部44は、進行方向手前側の点110pでの接線が第1部分110aと一致し、進行方向先側の点110qでの接線が第1ランプ状部110fと一致する2次曲線である第1曲線部110lを設ける。
 第2変更部44は、第1ランプ状部110fの終点110i側の端部を第2曲線部110mに変更する。実施の形態4では、第2変更部44は、進行方向手前側の点110rでの接線が第1ランプ状部110fと一致し、進行方向先側の点110sでの接線が第2部分110bと一致する2次曲線である第2曲線部110mを設ける。
 第2変更部44は、第2ランプ状部110gの始点110k側の端部を第3曲線部110nに変更する。実施の形態4では、第2変更部44は、進行方向手前側の点110tでの接線が第2部分110bと一致し、進行方向先側の点110uでの接線が第2ランプ状部110gと一致する2次曲線である第3曲線部110nを設ける。
 第2変更部44は、第2ランプ状部110gの終点110j側の端部を第4曲線部110oに変更する。実施の形態4では、第2変更部44は、進行方向手前側の点110vでの接線が第2ランプ状部110gと一致し、進行方向先側の点110wでの接線が第3部分110cと一致する2次曲線である第4曲線部110oを設ける。
 図16に示すフローチャートのステップS108~S114は、実施の形態1にかかる図3に示したフローチャートのステップS108~S114と同じであるので、説明を省略する。
 図18を参照すると、第1ランプ状部110fの中点110xは、第1エッジ部110dと重なっている。従って、X軸と第1エッジ部110dと波形110とで定まる領域Aの面積は、1/Rの直線と第1エッジ部110dと波形110とで定まる領域Bの面積と同じになる。
 第2ランプ状部110gの中点110yは、第2エッジ部110eと重なっている。従って、1/Rの直線と第2エッジ部110eと波形110とで定まる領域Cの面積は、X軸と第2エッジ部110eと波形110とで定まる領域Dの面積と同じになる。
 従って、図18に示す波形110とX軸とで定まる領域の面積、つまり車両50が走行軌道120を走行する場合の旋回角度は、図5に示す波形110とX軸とで定まる領域の面積、つまり車両50が基準走行軌道104を走行する場合の旋回角度と同じになる。
 これにより、実施の形態4にかかる運転支援装置は、車両50が道路100の脱出直線部103の路肩に寄ってしまうことを抑制することができ、車両50の安全性を確保することができる。
実施の形態5.
 実施の形態1から実施の形態4まででは、第1曲線部110l、第2曲線部110m、第3曲線部110n及び第4曲線部110oとして、2次曲線、3次以上の高次曲線又は指数曲線を例示した。しかしながら、本発明では、第1曲線部110l、第2曲線部110m、第3曲線部110n及び第4曲線部110oは、これらに限定されない。
 実施の形態5では、第1曲線部110l、第2曲線部110m、第3曲線部110n及び第4曲線部110oを、双曲線正接関数(ハイパボリックタンジェント、tanh)曲線とする場合について説明する。
 実施の形態5にかかる走行軌道作成装置の機能ブロックは、実施の形態1にかかる図2で示す走行軌道作成装置2と同様であるので、図示を省略する。
 実施の形態5にかかる走行軌道作成装置の処理を示すフローチャートは、実施の形態4にかかる図16で示すフローチャートと同様であるので、図示を省略する。
 第1変更部43は、ステップS104aにおいて、波形110の第1エッジ部110d及び第2エッジ部110eを第1ランプ状部110f及び第2ランプ状部110gに夫々変更し、第1ランプ状部110fの中点110xが第1エッジ部110dに重なり、第2ランプ状部110gの中点110yが第2エッジ部110eに重なるように、第1ランプ状部110f及び第2ランプ状部110gを設ける。
 図19は、実施の形態5にかかる運転支援装置で作成される波形の一例を示す図である。第1変更部43は、波形110の第1エッジ部110dをランプ状に変更し、第1ランプ状部110fを設ける。実施の形態5では、第1変更部43は、第1ランプ状部110fの中点110xが第1エッジ部110dに重なるように、第1ランプ状部110fを設ける。
 また、第1変更部43は、波形110の第2エッジ部110eをランプ状に変更し、第2ランプ状部110gを設ける。実施の形態5では、第1変更部43は、第2ランプ状部110gの中点110yが第2エッジ部110eに重なるように、第2ランプ状部110gを設ける。
 第1ランプ状部110f及び第2ランプ状部110gの傾きは、限定されず、任意の傾きとしても良いし、予め定められた傾きとしても良い。
 第2変更部44は、ステップS106において、第1ランプ状部110f及び第2ランプ状部110gの両端を曲線に変更し、第1曲線部110l、第2曲線部110m、第3曲線部110n及び第4曲線部110oを設ける。
 図20は、実施の形態5にかかる運転支援装置で作成される波形の一例を示す図である。第2変更部44は、第1ランプ状部110fの始点110h側の端部を第1曲線部110lに変更する。実施の形態5では、第2変更部44は、進行方向手前側の点110pでの接線が第1部分110aと一致し、第1ランプ状部110fの中点110xでの接線が第1ランプ状部110fと一致する双曲線正接関数曲線である第1曲線部110lを設ける。
 第2変更部44は、第1ランプ状部110fの終点110i側の端部を第2曲線部110mに変更する。実施の形態5では、第2変更部44は、第1ランプ状部110fの中点110xでの接線が第1ランプ状部110fと一致し、進行方向先側の点110sでの接線が第2部分110bと一致する双曲線正接関数曲線である第2曲線部110mを設ける。
 実施の形態5では、第2変更部44は、第1ランプ状部110fの中点110xで、第1曲線部110lと第2曲線部110mとを直結する。従って、波形110から第1ランプ状部110fがなくなる。
 第2変更部44は、第2ランプ状部110gの始点110k側の端部を第3曲線部110nに変更する。実施の形態5では、第2変更部44は、進行方向手前側の点110tでの接線が第2部分110bと一致し、第2ランプ状部110gの中点110yでの接線が第2ランプ状部110gと一致する双曲線正接関数曲線である第3曲線部110nを設ける。
 第2変更部44は、第2ランプ状部110gの終点110j側の端部を第4曲線部110oに変更する。実施の形態5では、第2変更部44は、第2ランプ状部110gの中点110yでの接線が第2ランプ状部110gと一致し、進行方向先側の点110wでの接線が第3部分110cと一致する双曲線正接関数曲線である第4曲線部110oを設ける。
 実施の形態5では、第2変更部44は、第2ランプ状部110gの中点110yで、第3曲線部110hと第4曲線部110oとを直結する。従って、波形110から第2ランプ状部110gがなくなる。
 図21は、実施の形態5にかかる運転支援装置で作成される波形の一例の一部拡大図である。図21は、図20の第1曲線部110l、第2曲線部110m、第3曲線部110n及び第4曲線部110oの近傍の拡大図である。
 図21を参照すると、X軸と第1エッジ部110dと波形110とで定まる領域Aの面積は、1/Rの直線と第1エッジ部110dと波形110とで定まる領域Bの面積と同じになる。1/Rの直線と第2エッジ部110eと波形110とで定まる領域Cの面積は、X軸と第2エッジ部110eと波形110とで定まる領域Dの面積と同じになる。
 従って、図20に示す波形110とX軸とで定まる領域の面積、つまり車両50が走行軌道を走行する場合の旋回角度は、図5に示す波形110とX軸とで定まる領域の面積、つまり車両50が基準走行軌道104を走行する場合の旋回角度と同じになる。
 これにより、実施の形態5にかかる運転支援装置は、車両50が道路100の脱出直線部103の路肩に寄ってしまうことを抑制することができ、車両50の安全性を確保することができる。
 図22は、実施の形態5にかかる走行軌道の曲率の2階微分の波形の一部拡大図である。走行軌道の曲率は、車両50の横方向の加速度に正比例する。走行軌道の曲率の1階微分は、車両50の横方向の加加速度(躍度、ジャーク(jerk))に正比例する。走行軌道の曲率の2階微分は、車両50の横方向の加加速度の変化率に正比例する。
 双曲線正接関数は、次の式(5)で表される。
  y=tanh(x) ・・・(5)
 式(5)の1階微分は、次の式(6)で表される。
  y’=sech(x) ・・・(6)
 式(5)の2階微分は、次の式(7)で表される。
 y’’=-2sech(x)・tanh(x) ・・・(7)
 図22に示すように、曲率の波形110の原点Oから点110pまでの部分110aは、0である。従って、走行軌道の曲率の2階微分の波形130の、部分110aに対応する部分130aは、0となる。
 波形110の点110pから点110xまでの第1曲線部110lは、双曲線正接関数曲線である。双曲線正接関数の2階微分は、上記の式(7)の通りである。従って、波形130の、第1曲線部110lに対応する部分130bは、式(7)で表される曲線となる。
 波形110の点110xから点110sまでの第2曲線部110mは、双曲線正接関数曲線である。第2曲線部110mは、点110xを中心として、第1曲線部110lと点対称である。従って、波形130の、点110xに対応する箇所から点110sに対応する箇所までの部分130cは、点130iを中心として、部分130cと点対称である。
 波形110の点110sから点110tまでの部分110bは、正の定数である。従って、波形130の、部分110bに対応する箇所までの部分130eは、0となる。
 波形110の点110tから点110yまでの第3曲線部110nは、双曲線正接関数曲線である。第3曲線部110nは、縦軸方向の直線を軸として、第2曲線部110mと線対称である。従って、波形130の、第3曲線部110nに対応する部分130fは、縦軸方向の直線を軸として、部分130cと線対称である。
 波形110の点110yから点110wまでの第4曲線部110oは、双曲線正接関数曲線である。第4曲線部110oは、縦軸方向の直線を軸として、第1曲線部110lと線対称である。従って、波形130の、第4曲線部110oに対応する部分130gは、縦軸方向の直線を軸として、部分130bと線対称である。
 波形110の点110w以降の部分110cは、0である。従って、波形130の、点110w以降に対応する箇所の部分130hは、0となる。
 実施の形態1で説明した図10を参照すると、第1曲線部110l、第2曲線部110m、第3曲線部110n及び第4曲線部110oを2次曲線とした場合は、曲率の2階微分の波形130は、エッジ部分を有する。エッジ部分では、車両50の横方向の加加速度が急激に変化するので、車両50が横滑りする可能性があり、乗員が不快感を感じる可能性がある。
 一方、実施の形態5では、図22に示すように、波形130は、全区間において、滑らかに変化している。より詳細には、波形130は、部分130bの開始部、部分130bと部分130cとの接続部、部分130cの終了部、部分130fの開始部、部分130fと部分130gとの接続部、及び、部分130gの終了部において、滑らかに変化している。
 従って、走行軌道作成装置2は、車両50の横方向の加加速度の変化率が滑らかに変化する走行軌道を作成することができる。つまり、走行軌道作成装置2は、車両50が滑らかに走行できる走行軌道を作成することができる。これにより、走行軌道作成装置2は、車両50の横滑りの発生を抑制できるとともに、乗員の不快感を抑制することができる。
 なお、実施の形態5では、第1曲線部110l、第2曲線部110m、第3曲線部110n及び第4曲線部110oを双曲線正接関数曲線としたが、これに限定されない。第1曲線部110l、第2曲線部110m、第3曲線部110n及び第4曲線部110oの他の例は、シグモイド関数(sigmoid function)曲線が例示される。
 シグモイド関数は、次の式(8)で表される。
  y=(tanh(x/2)+1)/2 ・・・(8)
 従って、走行軌道作成装置2は、第1曲線部110l、第2曲線部110m、第3曲線部110n及び第4曲線部110oをシグモイド関数曲線としても、双曲線正接関数曲線とした場合と同様に、車両50の横方向の加加速度の変化率が滑らかに変化する走行軌道を作成することができる。つまり、走行軌道作成装置2は、車両50が滑らかに走行できる走行軌道を作成することができる。これにより、走行軌道作成装置2は、車両50の横滑りの発生を抑制できるとともに、乗員の不快感を抑制することができる。
 以上の実施の形態に示した構成は、本発明の内容の一例を示すものであり、別の公知の技術と組み合わせることも可能であるし、本発明の要旨を逸脱しない範囲で、構成の一部を省略、変更することも可能である。
 1,1A,1B 運転支援装置、2,80 走行軌道作成装置、21 位置検出部、22,82 記憶部、23,81 制御部、24 表示部、25 アクチュエータ、26,71 通信部、27 記録媒体読取部、41 地図データ読出部、42 曲率波形作成部、43 第1変更部、44 第2変更部、45 走行軌道作成部、46 走行軌道表示部、47 アクチュエータ制御部、48 現在地送信部、49 走行軌道受信部、50 車両、60,61 運転支援システム、72 記録媒体書込部、83 現在地受信部、84 走行軌道送信部、90 記録媒体。

Claims (14)

  1.  進入直線部と、前記進入直線部に引き続く円弧部と、前記円弧部に引き続く脱出直線部と、を有する道路を車両が走行する走行軌道を作成する走行軌道作成装置であって、
     前記車両が前記道路を道なりに走行する場合の軌道であり、進入直線軌道と、前記進入直線軌道に引き続く円弧軌道と、前記円弧軌道に引き続く脱出直線軌道と、を有する基準走行軌道の曲率を表す波形を作成する曲率波形作成部と、
     前記波形の2つのエッジである第1エッジ部及び第2エッジ部の各々をランプ状に変更し、前記波形に第1ランプ状部及び第2ランプ状部を設ける第1変更部と、
     前記第1ランプ状部及び前記第2ランプ状部の各々の両端を曲線に変更し、前記波形に第1曲線部、第2曲線部、第3曲線部及び第4曲線部を設ける第2変更部と、
     前記波形に基づいて、前記走行軌道を作成する走行軌道作成部と、
     を備えることを特徴とする走行軌道作成装置。
  2.  前記第1曲線部、前記第2曲線部、前記第3曲線部及び前記第4曲線部は、2次曲線であることを特徴とする請求項1に記載の走行軌道作成装置。
  3.  前記第1曲線部、前記第2曲線部、前記第3曲線部及び前記第4曲線部は、双曲線正接関数曲線又はシグモイド関数曲線であることを特徴とする請求項1に記載の走行軌道作成装置。
  4.  前記第2変更部は、
     前記第1曲線部と前記第2曲線部とを直結し、前記第3曲線部と前記第4曲線部とを直結することを特徴とする請求項3に記載の走行軌道作成装置。
  5.  前記第1変更部は、
     前記第1ランプ状部及び前記第2ランプ状部の中点が前記第1エッジ部及び前記第2エッジ部に夫々重なるように、前記第1ランプ状部及び前記第2ランプ状部を設けることを特徴とする請求項1から4のいずれか1項に記載の走行軌道作成装置。
  6.  請求項1から5のいずれか1項に記載の走行軌道作成装置と、
     画像を表示する表示部と、
     前記走行軌道を前記表示部に表示させる走行軌道表示部と、
     を備えることを特徴とする運転支援装置。
  7.  請求項1から5のいずれか1項に記載の走行軌道作成装置と、
     前記車両のステアリングコラムを回転させるアクチュエータと、
     前記車両が前記走行軌道を走行するように、前記アクチュエータを動作させることで前記ステアリングコラムを回転させるアクチュエータ制御部と、
     を備えることを特徴とする運転支援装置。
  8.  前記走行軌道を記録媒体に書き込む記録媒体書込部を更に備えることを特徴とする請求項1から5のいずれか1項に記載の走行軌道作成装置。
  9.  請求項8に記載の走行軌道作成装置によって前記記録媒体に記録された前記走行軌道を読み取る記録媒体読取部と、
     画像を表示する表示部と、
     前記走行軌道を前記表示部に表示させる走行軌道表示部と、
     を備えることを特徴とする運転支援装置。
  10.  請求項8に記載の走行軌道作成装置によって前記記録媒体に記録された前記走行軌道を読み取る記録媒体読取部と、
     前記車両のステアリングコラムを回転させるアクチュエータと、
     前記車両が前記走行軌道を走行するように、前記アクチュエータを動作させることで前記ステアリングコラムを回転させるアクチュエータ制御部と、
     を備えることを特徴とする運転支援装置。
  11.  車両に搭載された運転支援装置と、前記運転支援装置と通信する走行軌道作成装置と、を備える運転支援システムであって、
     前記走行軌道作成装置は、
     前記車両の現在地を前記運転支援装置から受信する現在地受信部と、
     前記車両が道路を道なりに走行する場合の軌道であり、進入直線軌道と、前記進入直線軌道に引き続く円弧軌道と、前記円弧軌道に引き続く脱出直線軌道と、を有する基準走行軌道の曲率を表す波形を作成する曲率波形作成部と、
     前記波形の2つのエッジである第1エッジ部及び第2エッジ部の各々をランプ状に変更し、前記波形に第1ランプ状部及び第2ランプ状部を設ける第1変更部と、
     前記第1ランプ状部及び前記第2ランプ状部の各々の両端を曲線に変更し、前記波形に第1曲線部、第2曲線部、第3曲線部及び第4曲線部を設ける第2変更部と、
     前記波形に基づいて、前記走行軌道を作成する走行軌道作成部と、
     前記走行軌道を前記運転支援装置に送信する走行軌道送信部と、
     を備え、
     前記運転支援装置は、
     画像を表示する表示部と、
     前記走行軌道を前記走行軌道作成装置から受信する走行軌道受信部と、
     前記走行軌道を前記表示部に表示させる走行軌道表示部と、
     を備えることを特徴とする運転支援システム。
  12.  車両に搭載された運転支援装置と、前記運転支援装置と通信する走行軌道作成装置と、を備える運転支援システムであって、
     前記走行軌道作成装置は、
     前記車両の現在地を前記運転支援装置から受信する現在地受信部と、
     前記車両が道路を道なりに走行する場合の軌道であり、進入直線軌道と、前記進入直線軌道に引き続く円弧軌道と、前記円弧軌道に引き続く脱出直線軌道と、を有する基準走行軌道の曲率を表す波形を作成する曲率波形作成部と、
     前記波形の2つのエッジである第1エッジ部及び第2エッジ部の各々をランプ状に変更し、前記波形に第1ランプ状部及び第2ランプ状部を設ける第1変更部と、
     前記第1ランプ状部及び前記第2ランプ状部の各々の両端を曲線に変更し、前記波形に第1曲線部、第2曲線部、第3曲線部及び第4曲線部を設ける第2変更部と、
     前記波形に基づいて、前記走行軌道を作成する走行軌道作成部と、
     前記走行軌道を前記運転支援装置に送信する走行軌道送信部と、
     を備え、
     前記運転支援装置は、
     前記車両のステアリングコラムを回転させるアクチュエータと、
     前記車両が前記走行軌道を走行するように、前記アクチュエータを動作させることで前記ステアリングコラムを回転させるアクチュエータ制御部と、
     を備えることを特徴とする運転支援システム。
  13.  進入直線部と、前記進入直線部に引き続く円弧部と、前記円弧部に引き続く脱出直線部と、を有する道路を車両が走行する走行軌道を作成する走行軌道作成方法であって、
     前記車両が前記道路を道なりに走行する場合の軌道であり、進入直線軌道と、前記進入直線軌道に引き続く円弧軌道と、前記円弧軌道に引き続く脱出直線軌道と、を有する基準走行軌道の曲率を表す波形を作成する曲率波形作成ステップと、
     前記波形の2つのエッジである第1エッジ部及び第2エッジ部の各々をランプ状に変更し、前記波形に第1ランプ状部及び第2ランプ状部を設ける第1変更ステップと、
     前記第1ランプ状部及び前記第2ランプ状部の各々の両端を曲線に変更し、前記波形に第1曲線部、第2曲線部、第3曲線部及び第4曲線部を設ける第2変更ステップと、
     前記波形に基づいて、前記走行軌道を作成する走行軌道作成ステップと、
     を備えることを特徴とする走行軌道作成方法。
  14.  進入直線部と、前記進入直線部に引き続く円弧部と、前記円弧部に引き続く脱出直線部と、を有する道路を車両が走行する走行軌道を作成するためにコンピュータが実行する走行軌道作成プログラムであって、
     前記車両が前記道路を道なりに走行する場合の軌道であり、進入直線軌道と、前記進入直線軌道に引き続く円弧軌道と、前記円弧軌道に引き続く脱出直線軌道と、を有する基準走行軌道の曲率を表す波形を作成する曲率波形作成ステップと、
     前記波形の2つのエッジである第1エッジ部及び第2エッジ部の各々をランプ状に変更し、前記波形に第1ランプ状部及び第2ランプ状部を設ける第1変更ステップと、
     前記第1ランプ状部及び前記第2ランプ状部の各々の両端を曲線に変更し、前記波形に第1曲線部、第2曲線部、第3曲線部及び第4曲線部を設ける第2変更ステップと、
     前記波形に基づいて、前記走行軌道を作成する走行軌道作成ステップと、
     を備えることを特徴とする走行軌道作成プログラム。
PCT/JP2016/073641 2015-08-26 2016-08-10 走行軌道作成装置、方法及びプログラム、並びに、運転支援装置及びシステム WO2017033752A1 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
CN201680036296.XA CN108137048B (zh) 2015-08-26 2016-08-10 行驶轨道生成装置、方法和程序,以及驾驶辅助装置和系统
EP16839099.5A EP3296172B1 (en) 2015-08-26 2016-08-10 Travel track creation device, method, and program, and driving assistance device and system
US15/737,271 US10232851B2 (en) 2015-08-26 2016-08-10 Travel track creation device, method, and program, and driving assistance device and system
JP2016570363A JP6251421B2 (ja) 2015-08-26 2016-08-10 走行軌道作成装置、方法及びプログラム、並びに、運転支援装置及びシステム

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2015-167240 2015-08-26
JP2015167240 2015-08-26

Publications (1)

Publication Number Publication Date
WO2017033752A1 true WO2017033752A1 (ja) 2017-03-02

Family

ID=58100012

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2016/073641 WO2017033752A1 (ja) 2015-08-26 2016-08-10 走行軌道作成装置、方法及びプログラム、並びに、運転支援装置及びシステム

Country Status (5)

Country Link
US (1) US10232851B2 (ja)
EP (1) EP3296172B1 (ja)
JP (1) JP6251421B2 (ja)
CN (1) CN108137048B (ja)
WO (1) WO2017033752A1 (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2018203018A (ja) * 2017-06-02 2018-12-27 本田技研工業株式会社 走行制御装置、走行制御方法、およびプログラム
JP2020107114A (ja) * 2018-12-27 2020-07-09 株式会社トヨタマップマスター 演算装置、演算方法、演算プログラム及び記録媒体

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107963077B (zh) * 2017-10-26 2020-02-21 东软集团股份有限公司 一种车辆通过路口的控制方法、装置及系统
JP7151669B2 (ja) * 2019-08-29 2022-10-12 井関農機株式会社 作業車両

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003337993A (ja) * 2001-09-21 2003-11-28 Sanei Giken:Kk 運転支援システム、運転支援方法及び運転支援プログラム
JP2012066778A (ja) * 2010-09-27 2012-04-05 Toyota Motor Corp 走行軌跡作成装置
JP2014142235A (ja) * 2013-01-23 2014-08-07 Denso It Laboratory Inc カーブ形状モデル化装置、方法及び車載用ナビゲーション装置
JP2015074425A (ja) * 2013-10-11 2015-04-20 日産自動車株式会社 転舵制御装置及び転舵制御方法

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE60208616T2 (de) 2001-09-21 2006-07-13 Sanei Co., Ltd. System, Verfahren und Programm zur Unterstützung von Fahrzeugen
JP2004294953A (ja) 2003-03-28 2004-10-21 Toyota Central Res & Dev Lab Inc 道路形状復元装置
JP4756931B2 (ja) * 2004-07-01 2011-08-24 株式会社 三英技研 デジタルレーンマーク作成装置
ATE407345T1 (de) * 2004-11-19 2008-09-15 Harman Becker Automotive Sys Fahrzeugnavigation mit integrierter kurvenwarnung basiert auf klothoiden
EP2082936B1 (en) * 2008-01-23 2012-06-20 Aisin AW Co., Ltd. Speed control device for vehicle on curves
JP5546106B2 (ja) * 2008-01-23 2014-07-09 株式会社アドヴィックス 車両の運動制御装置
JP5749359B2 (ja) 2013-01-24 2015-07-15 アイサンテクノロジー株式会社 道路地図生成システム、道路地図生成装置、道路地図生成方法、及びナビゲーションシステム
JP5982034B1 (ja) * 2015-03-30 2016-08-31 富士重工業株式会社 車両の運転支援システム

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003337993A (ja) * 2001-09-21 2003-11-28 Sanei Giken:Kk 運転支援システム、運転支援方法及び運転支援プログラム
JP2012066778A (ja) * 2010-09-27 2012-04-05 Toyota Motor Corp 走行軌跡作成装置
JP2014142235A (ja) * 2013-01-23 2014-08-07 Denso It Laboratory Inc カーブ形状モデル化装置、方法及び車載用ナビゲーション装置
JP2015074425A (ja) * 2013-10-11 2015-04-20 日産自動車株式会社 転舵制御装置及び転舵制御方法

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2018203018A (ja) * 2017-06-02 2018-12-27 本田技研工業株式会社 走行制御装置、走行制御方法、およびプログラム
US10732642B2 (en) 2017-06-02 2020-08-04 Honda Motor Co., Ltd. Travel control apparatus, travel control method, and storage medium
JP2020107114A (ja) * 2018-12-27 2020-07-09 株式会社トヨタマップマスター 演算装置、演算方法、演算プログラム及び記録媒体
JP7015234B2 (ja) 2018-12-27 2022-02-02 株式会社トヨタマップマスター 演算装置、演算方法、演算プログラム及び記録媒体

Also Published As

Publication number Publication date
EP3296172A1 (en) 2018-03-21
CN108137048A (zh) 2018-06-08
JP6251421B2 (ja) 2017-12-20
CN108137048B (zh) 2019-09-03
JPWO2017033752A1 (ja) 2017-08-24
EP3296172B1 (en) 2020-05-06
US20180170376A1 (en) 2018-06-21
EP3296172A4 (en) 2018-11-07
US10232851B2 (en) 2019-03-19

Similar Documents

Publication Publication Date Title
CN108692699B (zh) 用于防撞辅助的车辆和方法
JP6447639B2 (ja) 目標経路生成装置および走行制御装置
JP6565054B2 (ja) 走行軌道作成装置、方法及びプログラム、並びに、運転支援装置及びシステム
JP6251421B2 (ja) 走行軌道作成装置、方法及びプログラム、並びに、運転支援装置及びシステム
US20170057544A1 (en) Vehicle traveling control apparatus
EP3405374B1 (en) Deceleration curb-based direction checking and lane keeping system for autonomous driving vehicles
CA2973113C (en) Target pathway generating device and driving control device
KR102613822B1 (ko) 다중 차선 방향전환 전체에 걸친 차량들의 제어
US20180154902A1 (en) Vehicle control using road angle data
WO2016110732A1 (ja) 目標経路生成装置および走行制御装置
JP2020502609A (ja) センサデータから得られた物体の地図情報を使用した平滑化
WO2019187716A1 (ja) 駐車支援装置
US10831203B2 (en) Vehicle controller and method
CN116867675A (zh) 车辆运动规划系统与方法
KR101837393B1 (ko) 차량, 및 그 제어방법
JP6365688B2 (ja) 前方注視点距離設定装置および走行制御装置
WO2016110730A1 (ja) 目標車速生成装置および走行制御装置
CN112810611B (zh) 用于车道变换控制的侧向轨迹追踪方法及系统
TWI719663B (zh) 用於車道變換控制的側向軌跡追蹤方法及系統
Luan et al. Design and field testing of a lane following control system with a camera based on t&c driver model
JP6654962B2 (ja) 車両の操舵制御装置

Legal Events

Date Code Title Description
ENP Entry into the national phase

Ref document number: 2016570363

Country of ref document: JP

Kind code of ref document: A

121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 16839099

Country of ref document: EP

Kind code of ref document: A1

WWE Wipo information: entry into national phase

Ref document number: 2016839099

Country of ref document: EP

WWE Wipo information: entry into national phase

Ref document number: 15737271

Country of ref document: US

NENP Non-entry into the national phase

Ref country code: DE