The present invention relates to a control system, a traveling controller and, a controlling method.
Conventionally, for controlling traveling of a vehicle, there has been proposed a technique disclosed in Japanese Unexamined Patent Application Publication No. 2019-111882. In this publication, there is a description “A vehicle controller includes: a first recognition unit configured to recognize one or more other vehicles existing around an own vehicle; a second recognition unit configured to recognize that a road on which the own vehicle travels is a road that does not have a center line; an estimation unit configured to estimate a state of a driver of an oncoming vehicle that faces the own vehicle among the one or more other vehicles recognized by the first recognition unit; a determination unit configured to determine whether or not the oncoming vehicle recognized by the first recognition unit is a vehicle that is traveling by a manual operation; and a control unit configured to decelerate the own vehicle to a predetermined speed or below based on a state of the driver of the oncoming vehicle when the oncoming vehicle is traveling by a manual operation and the road on which the own vehicle travels is the road that does not have the center line”.
The above-mentioned prior art can support passing by of the own vehicle with the oncoming vehicle on a road having no center line. However, the prior art is not intended to make the entire operation of the traveling body efficient. In recent years, a position and a speed of a traveling body can be controlled with high accuracy. However, such a control with high accuracy is not reflected on a traveling path on which a traveling body travels and hence, the operation in accordance with the traveling path has a limit in the enhancement of efficiency. The traveling body may be a vehicle, for example. Lanes are provided to a road that is a traveling path in accordance with a conventional standard, and traveling of a vehicle is controlled using one lane as a unit. As another case, a working robot may be a traveling body, for example. In this case, a lane having a width that allows the largest working robot to travel is provided to a zone that is a traveling path disposed in an area of a plant.
It is an object of the present invention to realize an efficient operation of a traveling body.
To achieve the above-mentioned object, one typical control system according to the present invention includes: a traveling route control unit configured to control information on a traveling path on which a traveling body travels; a traveling body position control unit configured to communicate with the traveling body and configured to control at least positional information on the traveling body; a lane setting unit configured to dynamically set a lane on the traveling path using at least positional information on the traveling body and a size of the traveling body; and a control information setting unit configured to set control information for controlling traveling of the traveling body in the lane.
One typical traveling controller according to the present invention is a traveling controller mounted on a traveling body that travels on a traveling path. The traveling controller includes: a communication unit configured to communicate with a control center; a positional information notification unit configured to acquire positional information on an own traveling body and configured to transmit the positional information via the communication unit; and a traveling control unit configured to acquire information on a lane dynamically set in the traveling path and control information set with respect to the lane from the control center and configured to control traveling of the own traveling body.
One typical controlling method according to the present invention includes: a traveling path control step of controlling information on a traveling path on which a traveling body travels; a traveling body position control step of communicating with the traveling body and of controlling at least positional information on the traveling body; a lane setting step of dynamically setting a lane on the traveling path using at least positional information on the traveling body and a size of the traveling body; and a control information setting step of setting control information for controlling traveling of the traveling body in the lane.
According to the present invention, it is possible to realize an efficient operation of the traveling body. Objects, configurations and advantageous effects other than the above will become apparent based on the description of an embodiment made hereinafter.
An embodiment of the present invention is described with reference to drawings hereinafter.
The control center 100 has a central control center 110 and one or a plurality of local control centers 120. The central control center 110 receives an operation of an operator by a control user interface (UI) 101. The central control center includes a traveling route control unit 111, a traveling body information control unit 112, and a route control unit 113.
The local control center 120 acquires sensor outputs from a plurality of infrastructure sensors 102 set on a traveling path. The local control center 120 includes a traveling body position control unit 121, a lane setting unit 122, a control information setting unit 123, and a communication unit 124.
The traveling route control unit 111 controls information on the traveling path on which the traveling body travels as map data. The map data contains information on a link that identifies a road on which a vehicle travels, information on existing lanes statically set on the road, and the like as information on the traveling path.
The traveling body information control unit 112 is a unit that controls information relating to the traveling body. The traveling body is a vehicle 130, for example. Information set with respect to the traveling body contains an actual vehicle width, an actual vehicle length, the degree of priority, and the like.
The route control unit 113 performs a route control by setting the destination and the route of the traveling body. Specifically, the route control unit 113 can set the route on which the vehicle 130 is scheduled to travel using a present place and the destination of the vehicle 130 and by referencing the map data controlled by the traveling route control unit 111. The route control unit 113, in controlling the routes of a plurality of vehicles 130, can realize a smooth and efficient operation of the plurality of vehicles 130 by setting the destinations and the routes of the plurality of vehicles 130 in a comprehensive manner.
The traveling body position control unit 121 controls the positions of the plurality of vehicles 130, the positions of obstacles on the traveling paths, and the like using an output from the infrastructure sensor 102 and positional information received from the plurality of the vehicles 130. The traveling body position control unit 121 can also control the acquisition of information such as a speed of the traveling body.
The lane setting unit 122 dynamically sets the lane on the traveling path using at least the positional information on the traveling body and the size of the traveling body. The positional information on the traveling body can be obtained from the traveling body position control unit 121. It is also possible to acquire a speed of the traveling body from the traveling body position control unit 121. A size of the traveling body and the like can be obtained from the traveling body information control unit 112.
Specifically, the lane setting unit 122 dynamically sets a virtual lane with respect to a road indicated in the map data. Priority can be assigned to the virtual lane that is virtual to a static lane contained in the map data. Although described later in detail, the lane setting unit 122 sets a virtual vehicle width by taking into account a traveling speed of the traveling body with respect to a vehicle width of the traveling body and sets the virtual vehicle width as a width of the virtual lane. Further, the lane setting unit 122 performs zoning of the lane at every predetermined length. The predetermined length may be a fixed value or may be obtained based on a vehicle length.
The control information setting unit 123 sets control information for controlling the traveling in the virtual lane set by the lane setting unit 122. The control information is set for every zone. The control information is set corresponding to the degrees of priority set to the traveling bodies existing on the lane and lanes in the periphery of the lane. By setting the control information in this manner, for example, in a case where a plurality of traveling bodies having different degrees of priority travel in the same direction, one of the plurality of virtual lanes is set as an overtaking lane. Accordingly, it is possible to allow the traveling body having a high degree of priority to change the lane to the overtaking lane and to overtake the traveling body having a low degree of priority.
The communication unit 124 is a communication interface used for communication with the plurality of vehicles 130. For example, the reception of positional information and speed information from the vehicle 130 and the transmission of the route information and the degree of priority with respect to the vehicle 130 are performed via the communication unit 124.
The vehicle 130 includes a global positioning system (GPS) unit 131, a sensor 132, a communication unit 133, map data 134, a vehicle control unit 135, information control unit 136, and the like.
The GPS unit 131 is a unit that identifies the positional information by receiving a signal from a GPS artificial satellite. The sensor 132 is used for detecting a state of the own vehicle and a state of the surrounding of the own vehicle. The communication unit 133 is a communication interface used for communication with the control center 100. For example, the transmission of the positional information and speed information to the control center 100 and reception of route information, the degree of priority, and the like from the control center 100 are performed via the communication unit 133. The map data 134 contains information on a link that identifies a road on which the vehicle travels, information on an existing lane statically set on the road, and the like as information on the traveling path.
The vehicle control unit 135 has a function of a positional information notification unit that acquires positional information on the own traveling body and transmits the positional information via the communication unit 133, and has a function of a traveling control unit that acquires information on the virtual lane and the control information from the control center 100 and controls traveling of the vehicle.
As an example, the vehicle control unit 135 includes functional units such as a vehicle position estimation unit 141, a route reception unit 142, and a lane change control unit 143. The vehicle position estimation unit 141 estimates with high accuracy the position of the own vehicle using the positional information acquired using the GPS unit 131, an output of the sensor 132, and the like. The estimated positional information is used for the transmission to the control center 100 and for a traveling control of the own vehicle. The route reception unit 142 receives a route on which the own vehicle is scheduled to travel from the control center 100 and controls the route. The lane change control unit 143 realizes a lane change by controlling traveling of the vehicle in accordance with a virtual lane designated by the control center 100 and control information.
The information control unit 136 controls various kinds of information which are necessary for traveling in association with the control center 100 such as a vehicle ID by which the own vehicle is identified, a vehicle width risk determined based on an actual vehicle width and a speed, and the degree of priority designated by the control center 100.
The control center 100 acquires information on the positions and the speeds from the plurality of vehicles 130 that are under control of the control center 100. The control center 100 finely divides the lane into divided lanes respectively having vehicle widths that correspond to speeds of the vehicles 130 (step S103), and changes control information on the divided lanes corresponding to the positions of the vehicles (step S104).
Each vehicle 130 acquires control information on the lane of the traveling route of the own vehicle (step S111), and travels on the lane in accordance with the acquired control information (step S112).
When the prepared control database exists (step S201; Yes), the control center 100 reads the prepared control database (step S202), and finishes the processing.
When the prepared control database does not exist (step S201; No), the control center 100 adds a traveling direction corresponding to a country or a region as control information on a lane (step S203), adds “follow preceding vehicle” to each lane as control information (step S204), and finishes the processing.
The control center 100 transmits the received input to the vehicle 130 corresponding to the input, and receives an acknowledgement (ACK) from the vehicle 130. The vehicle 130 having the vehicle ID “311” registers the data that the vehicle 130 receives from the control center 100 in the information control unit 136 (step S311).
Next, the control UI 101 receives inputting of “vehicle ID: 324, vehicle width risk: 1.2, vehicle length risk: 1.0, degree of priority: B” from the operator.
The control center 100 transmits the received input to the vehicle 130 corresponding to the input, and receives an ACK from the vehicle 130. The vehicle 130 having a vehicle ID “324” registers the data that the vehicle 130 receives from the control center 100 in the information control unit 136 (step S312).
In
The control center 100 sets a virtual vehicle length larger than an actual vehicle length that is a vehicle length of an actual vehicle. An extent of an increase of the virtual vehicle length is determined based on a vehicle speed, and the virtual vehicle length is used as a length of a zone of the virtual lane.
In
The direction is the traveling direction set with respect to the virtual lane. A vehicle is allowed to travel in the direction set to the virtual lane. Further, the traveling direction on the virtual lane can be switched by the control center 100.
The vehicle indicates a vehicle that currently exists on the virtual lane. For example, in a case where “C, A” are described in the column “vehicle”, this implies that there exist two vehicles consisting of the vehicle having the degree of priority C and the vehicle having the degree of priority A. Further, in a case where an obstacle exists, such an obstacle is registered in the column of the vehicle.
The control 1 and the control 2 define modes in which a vehicle existing on the virtual lane travels. In the control 1, controls such as “move forward/follow preceding vehicle”, “transmit collision avoiding request”, “entrance prohibited”, “advance to place where forward movement is allowed” are registered. In the control 2, “change lane when the own vehicle is travelable and the degree of priority of the own vehicle is “MAX”, “notify stop of the vehicle to the control center 100 after the own vehicle is stopped”, and the like are registered.
When the vehicle that overlaps with the emergency vehicle does not exist on the route (step S401; No), the control center 100 directly finishes the processing. When the vehicle that overlaps with the emergency vehicle exists on the route (step S401; Yes), the control center 100 calculates an empty road width necessary for passing of the emergency vehicle based on a speed and a vehicle width of the emergency vehicle (step S402).
After step S402, the control center 100 determines whether or not an empty road for the emergency vehicle can be ensured (step S403). When the empty road for the emergency vehicle can be ensured (step S403; Yes), the control center 100 changes the virtual lane such that the emergency vehicle can pass (step S404), and finishes the processing. When the control center 100 cannot ensure the empty road for the emergency vehicle (step S403; No), the control center 100 instructs again a retrieval of a route on which the vehicle overlapping with the emergency vehicle can pass (step S405), and finishes the processing.
In such a state, the control center 100 performs a passing control corresponding to the degree of priority instead of rules such as a rule that priority is assigned to straight advancing. Specifically, first, the vehicle having the degree of A is instructed to turn right and the vehicles having the degree of priority B and the degree of priority C are instructed to standby. Then, the vehicle having the degree of priority B is allowed to pass, and the vehicle having the degree of priority C is allowed to pass last.
In a case 1 illustrated in
In the case 1 illustrated in
In a case 2 illustrated in
In the case 2 illustrated in
At a point of time T0, the traveling direction on the lane L100 and the traveling direction on the lane L101 are set opposite to each other. A vehicle having the degree of priority C exists in the zone (1) of the lane L100, and an obstacle exists in the zone (2). A vehicle having the degree of priority A and a vehicle having the degree of priority B exist in the zone (2) of the lane L101.
At a point of time T1, a vehicle having the degree of priority A exists behind a vehicle having the degree of priority C in the zone (1) of the lane L100, and a vehicle having the degree of priority B exists in the zone (4) of the lane L101. The traveling direction is switched in the zone (1) to the zone (3) on the lane L101 and agrees with the traveling direction on the lane L100.
At a point of time T2, the vehicle having the degree of priority A changes the lane from the zone (1) of the lane L100 to the zone (1) of the lane L101, and returns to the zone (3) of the lane L100 in the zone (3) of the lane L101.
At a point of time T3, in the zone (1) to the zone (3) of the lane L101, the traveling direction returns to the original traveling direction so that a vehicle having the degree of priority B can pass.
With respect to a point of time T1 in
With respect to a point of time T2 in
With respect to a point of time T3 in
At a point of time T0, the lane L100 and the lane L101 adopt the same traveling direction. In the lane L100, a vehicle having the degree of priority A exists in the zone (1), a vehicle having the degree of priority B exists in the zone (2), and a vehicle having the degree of priority C exists in the zone (3).
At the point of time T1, the vehicle having the degree of priority A changes the lane to the lane L101 from the zone (1) of the lane L100, and overtakes the vehicle having the degree of priority B and the vehicle having the degree of priority C. The vehicle having the degree of priority B and the vehicle having the degree of priority C advance by one zone, respectively.
At a point of time T2, the vehicle having the degree of priority B changes the lane to the lane L101 from the zone (3) of the lane L100. The vehicle having the degree of priority C advances by one zone and has left the link L10.
That is, in this example, it is possible to change the lane sequentially from the vehicle having the higher degree of priority without changing the control 1 and the control 2.
Although the case where the vehicle is a traveling body has been described heretofore, substantially the same control is applicable to other cases including a case where working robots are made to travel in a plant.
In
For example, in a case where a working robot having the degree of priority A and a working robot having the degree of priority B face each other, virtual lanes are set based on sizes of the respective working robots, and control information is set such that the working robot having the lower degree of priority B gives way. When the working robot having the degree of priority B is movable in a lateral direction, it is possible to ensure an advancing path for the working robot having the degree of priority A by making the working robot having the degree of priority B retract between pillars.
As has been described above, the control system according to the embodiment includes: the traveling route control unit 111 configured to control information on the traveling path on which the traveling body travels; the traveling body position control unit 121 configured to communicate with the traveling body and configured to control at least positional information on the traveling body; the lane setting unit 122 configured to dynamically set a lane on the traveling path using at least positional information on the traveling body and a size of the traveling body; and the control information setting unit 123 configured to set control information for controlling traveling to the lane.
With such a configuration and the manner of operation, the lane can be set in conformity with the situation and a travel control can be performed. Accordingly, the traveling body can be driven efficiently.
As an example, the traveling body is a vehicle, and the traveling route control unit 111 controls the road on which the vehicle travels and the lane information statically set with respect to the road as information on the traveling path, and the lane setting unit 122 dynamically sets the virtual lane with respect to the road. Accordingly, an operation of the vehicle that travels on a road can be performed efficiently.
Further, according to the embodiment, the control system further includes the traveling body information control unit 112 configured to control the degree of priority set with respect to the traveling body, and the control information setting unit 123 sets the control information corresponding to the degree of priority set to the traveling body that exists on the lane and lanes in the periphery of the lane with respect to the lane set by the lane setting unit 122.
Accordingly, an operation of the traveling body can be controlled by taking into account the priority relationship.
As an example, the control information setting unit 123, when a plurality of traveling bodies having different degrees of priority are traveling in the same direction, sets one of the plurality of lanes as an overtake lane, and allows the traveling body having the high degree of priority to change its lane to the overtake lane and to overtake the traveling body having the low degree of priority.
Accordingly, it is possible to allow the traveling body having the high degree of priority to perform overtake driving by dynamically setting the lane.
Further, the lane setting unit 122 is characterized by setting a virtual vehicle width corresponding to a vehicle width of the traveling body while taking into account a traveling speed of the traveling body and by setting the virtual vehicle width as a width of the lane.
Accordingly, the lane can be dynamically set corresponding to an actual size of the traveling body and a speed of the traveling body.
The lane setting unit 122 performs zoning of the lane at every predetermined length, and the control information setting unit 123 sets the control information for every zone.
Accordingly, traveling of the traveling body can be controlled in detail using the control information.
According to the control system of the exemplified embodiment, the control system further includes the route control unit 113 configured to perform a route control by setting the destinations and routes of the traveling bodies. Accordingly, an operation of a plurality of traveling bodies can be controlled in a comprehensive manner.
According to the exemplified embodiment, the traveling controller mounted on the traveling body that travels on the traveling path includes: the communication unit 133 configured to communicate with the control center 100; the positional information notification unit configured to acquire positional information on the own vehicle and configured to transmit the positional information via the communication unit; and the traveling control unit configured to acquire information on the lane dynamically set on the traveling path and control information set with respect to the lane from the control center, and configured to control traveling of the own traveling body.
Accordingly, traveling can be controlled in accordance with the lane dynamically set by the control center 100, and the control information set with respect to the lane.
The present invention is not limited to the above-mentioned exemplified embodiment, and embraces various modifications. For example, the above-mentioned exemplified embodiment is described in detail for facilitating the understanding of the present invention, and is not always limited to the control system that includes all constituent elements described in the exemplified embodiment. Further, the present invention also embraces not only the deletion of the constituent elements but also the replacement and the addition of the constituent elements.
Number | Date | Country | Kind |
---|---|---|---|
2021-043163 | Mar 2021 | JP | national |