Vehicle control device and program
By detecting the turning radius deviation in the vehicle in real time and adjusting the driving wheel speed, the turning radius deviation problem during the vehicle's turn is solved, and the stable turning and efficient item handling of the vehicle are achieved.
Patent Information
- Application Number
- CN202380029845.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Priority Date
- 2022-03-28
- Filing Date
- 2023-03-02
- Publication Date
- 2024-11-15
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
When a vehicle turns, the deviation of the turning radius caused by changes in load capacity or driving path may cause the vehicle to be unable to turn properly, affecting driving stability and item handling efficiency.
By installing independently driven drive wheels in the vehicle, using rotation control, turning state determination and adjustment components, the turning radius deviation is detected in real time and the rotation speed of the drive wheel is adjusted, and the turning radius of the vehicle is appropriately adjusted, including weight determination, turning radius determination and Adjust the commands to ensure the vehicle is traveling stably on the expected path.
It realizes appropriate driving when the vehicle turns, avoids vehicle deflection or item collapse caused by deviation of turning radius, and improves driving stability and handling efficiency.
Smart Images

Figure CN118973845A_ABST
Abstract
Description
Citation of related applications
[0001] This application is based on Japanese Patent Application No. 2022-052566 filed on March 28, 2022, and the contents thereof are incorporated herein by reference. Technical Field
[0002] The disclosure in this specification relates to a vehicle control device and a program for controlling the travel of a vehicle having a pair of drive wheels that are driven independently. Background Art
[0003] Conventionally, as a vehicle used for transporting articles, for example, there is known a vehicle that can travel on a desired travel path by installing electric motors in each of a plurality of wheels and independently driving each of the wheels (see, for example, Patent Document 1). In addition, as an unmanned guided vehicle, a technology is being studied that includes a pair of left and right wheels including in-wheel electric motors, and the vehicle is driven in any state of going straight, turning right, or turning left by individually controlling each of the wheels. Prior art literature Patent Literature
[0004] Patent Document 1: Japanese Patent Application Publication No. 2015-95987 Summary of the invention
[0005] However, when the vehicle is driven, the amount of articles loaded in the vehicle may change, or the driving conditions along the driving path may change. Therefore, when the vehicle turns, the turning radius may be unintentionally larger than the desired turning path, or the turning radius may be unintentionally smaller than the desired turning path.
[0006] The present disclosure has been made in view of the above circumstances, and an object of the present disclosure is to provide a vehicle control device and a program capable of appropriately turning the vehicle in a vehicle having a pair of independently driven drive wheels.
[0007] The various methods disclosed in this specification use different technical means to achieve various purposes. The purposes, features and effects disclosed in this specification can be more clearly understood by referring to the subsequent detailed description and drawings.
[0008] Mode 1 is a control device, The control device is applicable to a vehicle including a pair of drive wheels, the pair of drive wheels being installed at two positions on the left and right relative to the vehicle's traveling direction, and each of the drive wheels having a motor and being driven independently. The control device controls the travel of the vehicle by controlling the driving of each of the driving wheels, and the control device includes: a rotation control unit configured to control a rotation speed of each of the drive wheels when the vehicle is traveling; a turning state determination unit for determining a deviation of an actual turning radius from a target turning radius when the vehicle is turning; and a regulating unit for regulating a rotation speed of each of the drive wheels implemented by the rotation control unit based on the deviation of the turning radius.
[0009] In a vehicle having a pair of independently driven driving wheels, the vehicle can go straight and turn left or right by controlling the pair of driving wheels. Moreover, in the control device, when the vehicle turns, the deviation of the actual turning radius from the target turning radius is determined, and the rotation speed of each driving wheel is adjusted based on the deviation of the turning radius. In this case, the deviation of the turning radius in the vehicle can be appropriately adjusted. As a result, in a vehicle having a pair of independently driven driving wheels, the vehicle can be turned appropriately.
[0010] In method 2, it includes a weight determination unit, which obtains the weight of the vehicle and determines whether the weight is heavier than a predetermined reference weight. When the adjustment unit determines that there is a deviation in the turning radius, if it is determined that the weight is heavier than the reference weight, the turning speed of the vehicle is controlled by adjusting the rotation speed of each of the drive wheels. If it is determined that the weight is lighter than the reference weight, the difference in rotation speed of the pair of drive wheels is controlled. In the case where the turning radius of the vehicle deviates, if the weight of the vehicle is relatively heavy, it is desirable to adjust the centrifugal force when the vehicle turns by controlling the speed of the vehicle, so as to make the turning radius of the vehicle appropriate. In contrast, in the case where the turning radius of the vehicle deviates, if the weight of the vehicle is relatively light, it is desirable to adjust the balance of the rotation speeds of the left and right drive wheels to make the turning radius of the vehicle appropriate. Based on such a concept, in the case where it is determined that the turning radius of the vehicle deviates, if it is determined that the weight is heavier than the reference weight, the turning speed of the vehicle is controlled by adjusting the rotation speed of each drive wheel, and if it is determined that the weight is lighter than the reference weight, the difference in the rotation speeds of a pair of drive wheels is controlled. In this way, even if the weight of the vehicle changes, appropriate turning of the vehicle can be achieved.
[0012] In method 3, a vehicle driving system suitable for the above-mentioned vehicle to travel in a predetermined driving path includes a turning radius determination unit, and the above-mentioned turning radius determination unit determines whether the above-mentioned target turning radius at a corner portion in the above-mentioned driving path is greater than a predetermined reference radius. When the above-mentioned adjustment unit determines that there is a deviation in the above-mentioned turning radius, if it is determined that the above-mentioned target turning radius is greater than the above-mentioned reference radius, the turning speed of the above-mentioned vehicle is controlled by adjusting the rotation speed of each of the above-mentioned driving wheels, and if it is determined that the above-mentioned target turning radius is less than the above-mentioned reference radius, the difference between the rotation speeds of the above-mentioned pair of driving wheels is controlled.
[0013] In the case where the turning radius of the vehicle deviates, if the target turning radius of the corner in the driving path is relatively large, it is desired to adjust the centrifugal force when the vehicle turns by controlling the speed of the vehicle, so as to make the turning radius of the vehicle appropriate. In contrast, in the case where the turning radius of the vehicle deviates, if the target turning radius of the corner is relatively small, it is desired to adjust the balance of the rotation speeds of the left and right driving wheels to make the turning radius of the vehicle appropriate. Based on such a concept, in the case where it is determined that the turning radius of the vehicle deviates, if it is determined that the target turning radius of the corner is larger than the reference radius, the turning speed of the vehicle is controlled by adjusting the rotation speed of each driving wheel, and if it is determined that the target turning radius of the corner is smaller than the reference radius, the difference in the rotation speed of a pair of driving wheels is controlled. Thus, even if there is a difference in the size of the target turning radius of the corner in the driving path, appropriate turning driving of the vehicle can be achieved.
[0014] In mode 4, the turning state determination unit determines whether the actual turning radius is larger or smaller than the target turning radius when a deviation occurs between the actual turning radius and the target turning radius. When the adjustment unit controls the turning speed of the vehicle by adjusting the rotation speed of each of the driving wheels, if it is determined that the actual turning radius is larger than the target turning radius, the rotation speed of each of the driving wheels is reduced to reduce the turning speed of the vehicle; if it is determined that the actual turning radius is smaller than the target turning radius, the rotation speed of each of the driving wheels is increased to increase the turning speed of the vehicle; when the difference between the rotation speeds of the pair of driving wheels is controlled, if it is determined that the actual turning radius is larger than the target turning radius, the difference between the rotation speeds of the pair of driving wheels is increased; if it is determined that the actual turning radius is smaller than the target turning radius, the difference between the rotation speeds of the pair of driving wheels is reduced.
[0015] Thus, in either case where the actual turning radius is larger or smaller than the target turning radius, the rotation speed of each drive wheel can be appropriately adjusted, thereby enabling the vehicle to travel along a desired travel path.
[0016] In method 5, when the adjustment unit determines that there is a deviation in the turning radius, the adjustment unit calculates a first adjustment amount for adjusting the rotational speed of each of the driving wheels based on the deviation in the turning radius and the weight of the vehicle, and calculates a second adjustment amount for adjusting the rotational speed of each of the driving wheels based on the deviation in the turning radius and the target turning radius, and the rotational speed of each of the driving wheels is adjusted using the larger of the first adjustment amount and the second adjustment amount.
[0017] According to the above configuration, when the vehicle turns, the rotation speed of each drive wheel can be appropriately adjusted while taking into account the vehicle weight and the size of the target turning radius of the travel path.
[0018] Method 6 includes an adjustment command unit that, when a deviation of the turning radius exceeds a predetermined threshold value, instructs the adjustment of a wheel gauge (Japanese: レッド) which is the interval between the pair of drive wheels, or a wheelbase (Japanese: ホイールベース) between each wheel arranged at the front and rear sides in the direction of travel.
[0019] When the deviation of the turning radius exceeds a predetermined threshold, for example, when the vehicle turns excessively, it is considered to significantly reduce the turning speed of the vehicle to deal with it. However, the greater the degree of reduction in the speed of the vehicle, the lower the efficiency of transporting articles, etc. may become. In view of this, when the deviation of the turning radius exceeds a predetermined threshold, an instruction to adjust the wheel gauge or wheelbase of the vehicle is issued, so that appropriate vehicle travel can be achieved while suppressing excessive adjustment of the turning speed of the vehicle. BRIEF DESCRIPTION OF THE DRAWINGS
[0020] The above objects, other objects, features and advantages of the present disclosure will become more apparent with reference to the accompanying drawings and the following detailed description. Figure 1 It is a diagram showing a schematic structure of a vehicle. Figure 2 This is a diagram showing the travel paths of vehicles in the automated warehouse. Figure 3 It is a diagram illustrating the turning radius when a vehicle turns. Figure 4 This is a flowchart showing the processing steps of vehicle travel control. Figure 5 It is a diagram illustrating the turning radius when a vehicle turns. Figure 6 This is a flowchart showing the processing procedure of the vehicle travel control in the second embodiment. Figure 7 This is a flowchart showing a processing procedure of vehicle travel control in another example. Figure 8 (a) is a relationship diagram for obtaining the first adjustment amount, Figure 8 (b) is a relationship diagram for obtaining the second adjustment amount. DETAILED DESCRIPTION
[0021] The following is an explanation of the embodiment based on the accompanying drawings. The vehicle in this embodiment is an electric mobile body that can automatically travel by rotating a pair of drive wheels, and can be used as an unmanned transport vehicle for transporting articles, for example. However, it can also be used as a transport vehicle for transporting people or animals, etc. In addition, in the following embodiments, the same or equivalent parts are marked with the same symbols in the drawings, and the description of the parts with the same symbols is cited.
[0022] (First Embodiment) The vehicle 10 of the present embodiment is an unmanned guided vehicle used for transporting articles in an automated warehouse. Figure 1 shown.
[0023] exist Figure 1 In the figure, the vehicle 10 includes a vehicle body 11, a pair of driving wheels 21, 22, and a pair of driven wheels 31, 32. The pair of driving wheels 21, 22 are wheels installed at two positions (left and right positions) in a direction perpendicular to the traveling direction of the vehicle 10 and driven independently. The pair of driven wheels 31, 32 are wheels that rotate according to the rotation of the driving wheels 21, 22 and can turn freely.
[0024] Each driving wheel 21, 22 is a so-called in-wheel motor having an electric motor 23, 24 as a driving source. In the vehicle 10, an inverter 25, 26 is provided for each electric motor 23, 24. Each driving wheel 21, 22 preferably has a structure in which the electric motor 23, 24 and the inverter 25, 26 are integrally provided. Each electric motor 23, 24 is driven by power supplied from an on-board battery (not shown). In addition, each electric motor 23, 24 may also have a reduction gear.
[0025] One of the pair of driving wheels 21, 22 and the pair of driven wheels 31, 32 is arranged at the front side of the vehicle 10 in the direction of travel, and the other is arranged at the rear side of the vehicle 10 in the direction of travel. In the present embodiment, the pair of driving wheels 21, 22 is arranged at the front side in the direction of travel, and the pair of driven wheels 31, 32 is arranged at the rear side in the direction of travel. However, it is also possible to arrange the pair of driven wheels 31, 32 at the front side in the direction of travel, and the pair of driving wheels 21, 22 at the rear side in the direction of travel.
[0026] In the vehicle 10, the positions of the driving wheels 21, 22 and the positions of the driven wheels 31, 32 can be changed, respectively. By changing the positions of these wheels, the wheel gauge, which is the interval between the pair of driving wheels 21, 22, or the wheelbase between the wheels arranged at the front and rear sides in the traveling direction can be adjusted. Specifically, the vehicle body 11 has a plurality of mounting portions for each of the left and right driving wheels 21, 22 and the left and right driven wheels 31, 32, and the wheel gauge and the wheelbase can be adjusted by changing the mounting position of each wheel in the vehicle body 11. In the vehicle body 11, it is also possible to configure that the wheel mounting position can be changed by sliding the wheels when the wheels are mounted. In addition, it is also possible that only the driving wheels 21, 22 and the driven wheels 31, 32 can be changed in position.
[0027] The vehicle 10 can move forward, backward, and turn by independently driving the drive wheels 21 and 22. The vehicle 10 moves forward by rotating the drive wheels 21 and 22 together in the forward direction, and moves backward by rotating the drive wheels 21 and 22 together in the reverse direction. In addition, the vehicle 10 turns by making the rotation speeds of the left and right drive wheels 21 and 22 different from each other.
[0028] The vehicle body 11 has a loading portion (not shown) for loading articles. It is desirable that the loading portion be formed so that articles can be loaded and unloaded by a robot arm or the like in an automatic warehouse.
[0029] The vehicle 10 includes a control device 40 composed of a microcomputer, various memories, etc., a sensor 50 for detecting the state of the vehicle 10, and a communication device 60 capable of wireless communication with an external device 100. The control device 40 executes various programs stored in the memory. The sensor 50 includes, for example, a weight sensor for detecting the weight of the vehicle, a speed sensor for detecting the speed of the vehicle 10, a yaw rate sensor for detecting the lateral acceleration in the left and right directions of the vehicle 10, that is, the yaw rate, and an image sensor for photographing the surroundings of the vehicle 10. The weight sensor can detect the weight of the items loaded on the vehicle 10. In addition, the yaw rate sensor can detect the yaw rate (lateral acceleration) when the vehicle 10 turns. In addition, each inverter 25, 26 is provided with a current sensor for detecting the current flowing through the coil of each motor 23, 24.
[0030] The control device 40 controls the driving of each motor 23, 24 in each driving wheel 21, 22 based on the command signal from the external device 100 received by the communication device 60. Specifically, when the vehicle is running, the control device 40 receives the speed command value and the yaw rate command value (turning command value) of the vehicle 10 from the external device 100 via the communication device 60, and calculates the target rotation speed of each motor 23, 24 in the left and right driving wheels 21, 22 based on these speed command value and yaw rate command value, the wheel gauge of the vehicle 10, and the tire diameter of each driving wheel 21, 22. Then, the rotation speed feedback control is implemented by controlling the inverters 25, 26 so that the rotation speed of each motor 23, 24 becomes the target rotation speed.
[0031] Figure 2 is a diagram showing the travel path of the vehicle 10 in the automated warehouse. Figure 2 As shown, the vehicle 10 travels along the travel path B1 from the starting position A1 as the transport source to the end position A2 as the transport destination, and then travels along the travel path B2 from the end position A2, thereby returning to the starting position A1. In this case, the travel path B1 has, for example, two corners C1 and C2, and the curvature radii R1 and R2 of these corners C1 and C2 are R1<R2. On the ground in the automatic warehouse, it is best to set dot-shaped or line-shaped markings along the travel paths B1 and B2. In addition, the vehicle 10 can also travel back and forth between A1 and A2 on the travel path B1.
[0032] When the vehicle 10 travels along the travel path in the automatic warehouse, it is considered that the weight of the vehicle 10, that is, the total weight of the vehicle 10 including the load, changes every time the vehicle travels. That is, the vehicle weight is different when the vehicle 10 travels in the state of loading items and when the vehicle 10 travels in the state of not loading items. In addition, the vehicle weight varies according to the load amount of the items, etc. In this case, it is considered that if the vehicle weight is different, it will affect the vehicle driving state, especially when the vehicle 10 turns, it will become an understeering state (understeering state when turning) with a turning radius larger than the target radius, or an oversteering state (oversteering state when turning) with a turning radius smaller than the target radius. In addition, since the vehicle 10 cannot turn properly, it is possible that the vehicle 10 or the load will come into contact with surrounding objects, or the cargo of the items will collapse.
[0033] Therefore, in the present embodiment, when the vehicle 10 is turning, the deviation of the actual turning radius from the target turning radius is determined, and the rotation speed of each driving wheel 21, 22 is adjusted based on the deviation of the turning radius. In addition, in the present embodiment, the control device 40 corresponds to the rotation control unit, the turning state determination unit, the adjustment unit, and the weight determination unit.
[0034] The process of adjusting the rotation speed of each of the drive wheels 21 and 22 will be described. Figure 3 (a) is a diagram illustrating an understeering state in which the turning radius is larger than the target radius when the vehicle turns. Figure 3 (b) is a diagram for explaining an over-steering state in which the turning radius is smaller than the target radius when the vehicle turns. In addition, each of these figures shows a right turn state, and the rotation speed of the left drive wheel 21 is higher than the rotation speed of the right drive wheel 22. In addition, in each of these figures, the dotted line is the target trajectory, and the solid line is the actual trajectory.
[0035] exist Figure 3 In the understeering state shown in (a), the control device 40 controls the rotation speed of each drive wheel 21, 22 to reduce the turning radius of the vehicle 10. Specifically, the rotation speed of the two drive wheels 21, 22 is changed to the decreasing side to reduce the turning speed of the vehicle 10, thereby reducing the turning radius of the vehicle 10. Alternatively, in order to increase the difference in the rotation speeds of the left and right drive wheels 21, 22, the rotation speed of the left drive wheel 21 is changed to the increasing side (or the rotation speed of the right drive wheel 22 is changed to the decreasing side), thereby reducing the turning radius of the vehicle 10.
[0036] In addition, Figure 3 In the oversteering state shown in (b), the control device 40 controls the rotation speed of each drive wheel 21, 22 to increase the turning radius of the vehicle 10. Specifically, the rotation speed of the two drive wheels 21, 22 is changed to the increasing side to increase the turning speed of the vehicle 10, thereby increasing the turning radius of the vehicle 10. Alternatively, in order to reduce the difference in the rotation speeds of the left and right drive wheels 21, 22, the rotation speed of the right drive wheel 22 is changed to the increasing side (or the rotation speed of the left drive wheel 21 is changed to the decreasing side), thereby increasing the turning radius of the vehicle 10.
[0037] Figure 4 4 is a flowchart showing the processing steps of vehicle driving control. This processing is performed by the control device 40 every time the vehicle 10 starts to travel. For example, in an automatic warehouse, this processing is preferably performed when the vehicle 10 starts to travel from a transport source to a transport destination in a state where articles are loaded, and when the vehicle 10 starts to travel from a transport destination back to a transport source in a state where articles are not loaded.
[0038] exist Figure 4 In step S11, the weight of the vehicle 10 and information related to the target turning radius at the current time point in the vehicle travel path are obtained. At this time, the control device 40 obtains the weight detected by the weight sensor, for example. In addition, the control device 40 calculates the target turning radius based on the speed command value or the yaw rate command value of the vehicle 10 received from the external device 100. Alternatively, the control device may also be configured to receive the target turning radius of the vehicle travel path from the external device 100.
[0039] Then, in step S12, it is determined whether there is any adjustment data for driving control for the weight range to which the current vehicle weight belongs, that is, whether the adjustment data for adjusting the rotation speed (motor speed) of each driving wheel 21, 22 for the vehicle weight at the current time point before the current time point is stored in the memory in the control device 40. In addition, the vehicle weight is divided into a plurality of weight ranges, and the adjustment data for the rotation speed control is stored for each of these weight ranges.
[0040] If there is adjustment data for driving control, the process proceeds to step S13 to read adjustment data corresponding to the vehicle weight at the current time point from the memory. Thus, when the vehicle 10 turns, the adjustment data is used to appropriately adjust the rotation speed of each drive wheel 21, 22.
[0041] If there is no adjustment data for the travel control, the process proceeds to step S14 to determine whether the vehicle 10 is currently in a turning state. If the vehicle 10 is in a turning state, the process proceeds to step S15.
[0042] In step S15, it is determined whether the turning radius of the vehicle 10 is in a state of deviation when turning, and whether the deviation of the actual turning radius from the target turning radius is greater than a predetermined threshold value TH1. That is, the turning radius of the vehicle 10 conforms to the driving trajectory of the vehicle when turning, and as a deviation determination of the driving trajectory, the deviation of the actual turning radius from the target turning radius is determined. At this time, the turning radius of the vehicle 10 is preferably calculated based on the detection information of the sensor that detects the vehicle speed or yaw rate. In addition, it is also possible to detect a mark set in the driving path based on an image acquired by an image sensor, and calculate the turning radius based on the detection information.
[0043] If step S15 is "yes", the process proceeds to step S16 to determine whether the deviation of the turning radius is less than a threshold value TH2 which is greater than the threshold value TH1. Then, if step S16 is "yes", the process proceeds to step S17, and if step S16 is "no", the process proceeds to step S24.
[0044] In step S17, it is determined whether the weight of the vehicle 10 is heavier than a predetermined reference weight Ws. Then, if the vehicle weight is heavier than the reference weight Ws, the process proceeds to step S18, and if the vehicle weight is lighter than the reference weight Ws, the process proceeds to step S21. The reference weight Ws can be defined as the weight of an assumed standard load (e.g., 10 kg, 20 kg ..., 100 kg, 200 kg ..., etc.). In addition, the weight of the vehicle in an unloaded state, i.e., a state without a load, can also be used as the reference weight Ws.
[0045] In step S18, it is determined whether the actual turning radius is larger than the target turning radius, that is, whether the vehicle is in an understeering state. Then, if the vehicle is in an understeering state, the process proceeds to step S19 to reduce the rotation speed of the two drive wheels 21 and 22 and reduce the turning speed of the vehicle 10. In addition, if the vehicle is in an oversteering state, the process proceeds to step S20 to increase the rotation speed of the two drive wheels 21 and 22 and increase the turning speed of the vehicle 10. In steps S19 and S20, the adjustment results of the rotation speed (motor speed) of each drive wheel 21 and 22 are stored in the memory as adjustment data corresponding to the current vehicle weight. According to steps S18 to S20, when the turning radius of the vehicle 10 deviates and the vehicle weight is relatively heavy, the centrifugal force when the vehicle turns is adjusted by controlling the speed of the vehicle 10, thereby making the turning radius of the vehicle 10 appropriate.
[0046] In addition, in step S21, it is determined whether the actual turning radius is larger than the target turning radius, that is, whether it is in an understeering state. Then, if it is in the understeering state, proceed to step S22, for example, the rotation speed of the drive wheel on the outside of the turn is increased and the difference in rotation speed is increased. In addition, if it becomes an oversteering state, proceed to step S23, for example, the rotation speed of the drive wheel on the inside of the turn is increased and the difference in rotation speed is reduced. In steps S22 and S23, the adjustment results of the rotation speed (motor speed) of each drive wheel 21, 22 are stored in the memory as adjustment data corresponding to the current vehicle weight. According to steps S21 to S23, when the turning radius of the vehicle 10 deviates and the vehicle weight is relatively light, the balance of the rotation speed of each left and right drive wheel 21, 22 is adjusted to make the turning radius of the vehicle 10 appropriate.
[0047] In step S24, an instruction is issued to adjust either the wheel gauge or the wheel base of the vehicle 10. At this time, it is preferable that the wheel gauge adjustment instruction or the wheel base adjustment instruction is transmitted from the control device 40 to the external device 100.
[0048] Specifically, as the adjustment of the wheel-track gauge, if an understeering with a turning radius larger than the target turning radius occurs, it is preferable to instruct an adjustment of a command to increase the wheel-track gauge, and if an oversteering with a turning radius smaller than the target turning radius occurs, it is preferable to instruct an adjustment of a command to decrease the wheel-track gauge. In addition, as the adjustment of the wheelbase, specifically, if an understeering with a turning radius larger than the target turning radius occurs, it is preferable to instruct an adjustment of a command to decrease the wheelbase, and if an oversteering with a turning radius smaller than the target turning radius occurs, it is preferable to instruct an adjustment of a command to increase the wheelbase.
[0049] According to the present embodiment described in detail above, the following excellent effects can be obtained.
[0050] When the vehicle 10 is turning, the deviation of the actual turning radius from the target turning radius is determined, and the rotation speed of each driving wheel 21, 22 is adjusted based on the deviation of the turning radius. In this case, it is possible to appropriately adjust the deviation of the turning radius of the vehicle 10. As a result, in the vehicle 10 having a pair of independently driven driving wheels 21, 22, the vehicle 10 can be made to turn appropriately.
[0051] In the case where the turning radius of the vehicle 10 deviates, if the vehicle weight is relatively heavy, it is desirable to adjust the centrifugal force when the vehicle turns by controlling the speed of the vehicle 10, so as to make the turning radius of the vehicle 10 appropriate. In contrast, in the case where the turning radius of the vehicle 10 deviates, if the vehicle weight is relatively light, it is desirable to adjust the balance of the rotation speeds of the left and right drive wheels 21, 22 to make the turning radius of the vehicle 10 appropriate. Based on such a concept, in the case where it is determined that the turning radius of the vehicle 10 deviates, if it is determined that the vehicle weight is heavier than the reference weight Ws, the turning speed of the vehicle 10 is controlled by adjusting the rotation speeds of the drive wheels 21, 22, and if it is determined that the vehicle weight is lighter than the reference weight Ws, the difference between the rotation speeds of the pair of drive wheels 21, 22 is controlled. Thus, even if the vehicle weight changes, appropriate turning driving of the vehicle 10 can be achieved.
[0052] When controlling the turning speed of the vehicle 10, if the actual turning radius is larger than the target turning radius, the rotation speed of each drive wheel 21, 22 is reduced to reduce the turning speed of the vehicle 10, and if the actual turning radius is smaller than the target turning radius, the rotation speed of each drive wheel 21, 22 is increased to increase the turning speed of the vehicle. In addition, when controlling the difference in the rotation speed of a pair of drive wheels 21, 22, if the actual turning radius is larger than the target turning radius, the difference in the rotation speed of the pair of drive wheels 21, 22 is increased, and if the actual turning radius is smaller than the target turning radius, the difference in the rotation speed of the pair of drive wheels 21, 22 is reduced. Thus, in any case where the actual turning radius is larger or smaller than the target turning radius, the rotation speed of each drive wheel 21, 22 can be appropriately adjusted, and the vehicle can travel on a desired driving path.
[0053] When the deviation of the turning radius exceeds a predetermined threshold, for example, when the vehicle turns excessively, it is considered to significantly reduce the turning speed of the vehicle 10. However, the greater the degree of reduction in the speed of the vehicle 10, the lower the efficiency of transporting articles and the like. In view of this, when the deviation of the turning radius exceeds a predetermined threshold, an instruction to adjust the wheel gauge or wheelbase of the vehicle 10 is issued, so that appropriate vehicle travel can be achieved while suppressing excessive adjustment of the turning speed of the vehicle 10.
[0054] The wheel gauge or wheelbase of the vehicle 10 may be adjusted instead of or in addition to the adjustment of the rotation speed of each of the drive wheels 21 , 22 .
[0055] (Second Embodiment) Next, the differences between the structure of the second embodiment and the first embodiment are mainly described. In this embodiment, when it is determined that the turning radius has a deviation, it is determined whether the target turning radius of the corner portion in the driving path of the vehicle 10 is greater than a predetermined reference radius. If the target turning radius is greater than the reference radius, the turning speed of the vehicle 10 is controlled by adjusting the rotation speed of the two drive wheels 21 and 22. If the target turning radius is less than the reference radius, the difference in the rotation speed of each drive wheel 21 and 22 is controlled. In this embodiment, the control device 40 also corresponds to the turning radius determination unit.
[0056] The process of adjusting the rotation speed of each of the drive wheels 21 and 22 will be described. Figure 5 (a) is a diagram for explaining a turning state when the target turning radius is relatively large (larger than a predetermined reference radius) when the vehicle turns. Figure 5(b) is a diagram for explaining a turning state when the target turning radius is relatively small (smaller than a predetermined reference radius) when the vehicle turns.
[0057] exist Figure 5 In the state shown in (a), when the vehicle 10 is in an understeering or oversteering state, the control device 40 controls the turning speed of the vehicle 10 by adjusting the rotation speed of each drive wheel 21, 22, thereby adjusting the turning radius of the vehicle 10. Specifically, in the understeering state, the turning speed of the vehicle 10 is reduced by changing the rotation speed of the two drive wheels 21, 22 to the decreasing side. In the oversteering state, the turning speed of the vehicle 10 is increased by changing the rotation speed of the two drive wheels 21, 22 to the increasing side.
[0058] In addition, Figure 5 In the state shown in (b), when the vehicle 10 is in an understeering or oversteering state, the control device 40 adjusts the turning radius of the vehicle 10 by controlling the difference in the rotation speed of each drive wheel 21, 22. Specifically, in the understeering state, the rotation speed of the left drive wheel 21 is changed to the increasing side, so that the difference in the rotation speed of each drive wheel 21, 22 is increased. In the oversteering state, the rotation speed of the right drive wheel 22 is changed to the increasing side, so that the difference in the rotation speed of each drive wheel 21, 22 is reduced.
[0059] Figure 6 This is a flowchart showing the processing steps of vehicle driving control. Figure 4 In addition, in this process, Figure 4 Repeated processing is assigned the same step number and description thereof is omitted.
[0060] exist Figure 6 In the case where the current vehicle 10 is in a turning state (step S14 is "yes") and the deviation of the actual turning radius from the target turning radius is greater than the threshold value TH1 and less than the threshold value TH2 (steps S15 and S16 are both "yes"), proceed to step S31. In step S31, it is determined whether the target turning radius at the current time point is greater than the predetermined reference radius Rs. Then, if the target turning radius is greater than the reference radius Rs, proceed to step S18, and if the target turning radius is less than the reference radius Rs, proceed to step S21. The reference radius Rs is preferably determined by assuming a standard corner radius in the driving path. The corner radius with the largest number in the driving path may also be set as the reference radius Rs, or the average of the curvature radii of all corners may be set as the reference radius Rs.
[0061] In steps S18 to S20, when the turning radius of the vehicle 10 deviates and the target turning radius is larger than the reference radius Rs, if the vehicle is in an understeering state, the rotation speeds of the two driving wheels 21 and 22 are reduced to reduce the turning speed of the vehicle 10 (step S19), and if the vehicle is in an oversteering state, the rotation speeds of the two driving wheels 21 and 22 are increased to increase the turning speed of the vehicle 10 (step S20). Thus, the centrifugal force when the vehicle turns is adjusted by controlling the speed of the vehicle 10, and the turning radius of the vehicle 10 is optimized.
[0062] In steps S21 to S23, when the turning radius of the vehicle 10 deviates and the target turning radius is smaller than the reference radius Rs, if the vehicle is in an understeering state, the rotation speed of the driving wheel on the outer side of the turn is increased to increase the rotation speed difference (step S22), and if the vehicle is in an oversteering state, the rotation speed of the driving wheel on the inner side of the turn is increased to decrease the rotation speed difference (step S23). In this way, the balance of the rotation speeds of the left and right driving wheels 21 and 22 can be adjusted to make the turning radius of the vehicle 10 appropriate.
[0063] In the case where the turning radius of the vehicle 10 deviates, if the target turning radius of the corner in the driving path is relatively large, it is desirable to adjust the centrifugal force when the vehicle turns by controlling the speed of the vehicle 10, so as to make the turning radius of the vehicle 10 appropriate. In contrast, in the case where the turning radius of the vehicle 10 deviates, if the target turning radius of the corner is relatively small, it is desirable to adjust the balance of the rotation speeds of the left and right driving wheels 21 and 22 to make the turning radius of the vehicle 10 appropriate. Based on such a concept, in the case where it is determined that the turning radius of the vehicle 10 deviates, if it is determined that the target turning radius of the corner is larger than the reference radius Rs, the turning speed of the vehicle 10 is controlled by adjusting the rotation speeds of the driving wheels 21 and 22, and if it is determined that the target turning radius of the corner is smaller than the reference radius Rs, the difference in the rotation speeds of the pair of driving wheels 21 and 22 is controlled. Thus, even if there is a difference in the size of the target turning radius of the corner in the driving path, it is possible to achieve appropriate turning travel of the vehicle 10.
[0064] (Other embodiments) For example, the above-mentioned embodiment may be modified as follows.
[0065] It is also possible to configure such that, when it is determined that the turning radius when the vehicle turns has a deviation, a first adjustment amount for adjusting the rotation speed of each drive wheel 21, 22 is calculated based on the deviation amount of the turning radius and the weight of the vehicle 10, and a second adjustment amount for adjusting the rotation speed of each drive wheel 21, 22 is calculated based on the deviation amount of the turning radius and the target turning radius, and the rotation speed of each drive wheel 21, 22 is adjusted based on the first adjustment amount and the second adjustment amount. Specifically, the control device 40 preferably implements Figure 7 In addition, Figure 7 In the process, the vehicle weight, the acquisition process of the turning radius information, the turning determination process, etc. are omitted.
[0066] exist Figure 7 In step S41, it is determined whether the vehicle is in a state where the turning radius is deviated when turning, and in step S42, it is determined whether the vehicle is in an understeering state. Then, if both steps S41 and S42 are "yes", the process proceeds to step S43. In step S43, a first adjustment amount for adjusting the rotation speed of each driving wheel 21, 22 is calculated based on the deviation amount of the turning radius and the vehicle weight, and in the next step S44, a second adjustment amount for adjusting the rotation speed of each driving wheel 21, 22 is calculated based on the deviation amount of the turning radius and the target turning radius.
[0067] For the calculation of these adjustment amounts, specifically, for example, Figure 8 The relationship between (a) and the first adjustment amount is set to a larger value as the deviation of the turning radius or the weight increases. Figure 8 The relationship between (b) and the second adjustment amount is set to a larger value as the deviation of the turning radius increases or the target turning radius decreases. Preferably, each of these adjustment amounts includes an adjustment amount for changing the rotation speed of each drive wheel 21, 22 for changing the turning speed of the vehicle 10, or an adjustment amount for adjusting the difference in the rotation speed of each drive wheel 21, 22. The details are as described above. In addition, Figure 8 The relationship between (a) and (b) can be appropriately changed, for example, Figure 8 In (b), the second adjustment amount may be set to a larger value as the target turning radius increases.
[0068] Thereafter, in step S45 , the larger one of the adjustment amounts in steps S43 and S44 is finally stored in the memory as adjustment data.
[0069] If the answer is “Yes” in step S41 and “No” in step S42 , the process proceeds to step S46 . In steps S46 to S48 , calculation of the first adjustment amount and the second adjustment amount and storage of the adjustment data in the memory are performed in the same manner as in steps S43 to S45 .
[0070] According to the above configuration, when the vehicle 10 turns, the rotation speed of each of the drive wheels 21 and 22 can be appropriately adjusted while taking into account the vehicle weight and the size of the target turning radius of the travel path.
[0071] In the above-mentioned embodiments, when the turning radius deviates, the control of the turning speed of the vehicle 10 or the control of the difference in the rotation speed of each drive wheel is switched based on whether the weight is heavier than the reference weight or whether the target turning radius is larger than the reference radius, but it can also be changed. For example, when the turning radius deviates, the turning speed of the vehicle 10 is controlled regardless of whether the weight is heavier than the reference weight or whether the target turning radius is larger than the reference radius. Alternatively, when the turning radius deviates, the control of the difference in the rotation speed of each drive wheel is controlled regardless of whether the weight is heavier than the reference weight or whether the target turning radius is larger than the reference radius.
[0072] The adjustment data for adjusting the rotation speed of each drive wheel 21, 22 may be calculated during simulated driving instead of during actual article transport.
[0073] The vehicle 10 may be configured to be used as an automatic driving vehicle other than an automated warehouse. For example, when the vehicle is used outdoors, it is preferable to adjust the rotation speed of each drive wheel 21, 22 in consideration of environmental information such as map information and weather information.
[0074] In the above-described embodiment, the control device 40 is configured to perform a process of determining a deviation of an actual turning radius from a target turning radius (processing by a turning state determination unit) and a process of adjusting the rotation speed of each drive wheel 21, 22 based on the deviation of the turning radius (processing by an adjustment unit) when the vehicle 10 is turning. However, as an alternative, the external device 100 may perform at least one of the above-described processes.
[0075] In the above embodiment, the vehicle 10 is a four-wheel vehicle having a pair of driving wheels 21, 22 and a pair of driven wheels 31, 32, but it may be a vehicle other than a four-wheel vehicle. For example, it may be a three-wheel vehicle having a pair of driving wheels and one driven wheel. In addition, it may be a structure in which all four wheels are driving wheels.
[0076] The control unit and the method of the control unit described in the present disclosure may also be implemented by a special-purpose computer, which is provided by constituting a processor and a memory, and the above-mentioned processor is programmed to perform one or more functions embodied by a computer program. Alternatively, the control unit and the method thereof described in the present disclosure may be implemented by a special-purpose computer, which is provided by constituting a processor composed of one or more special-purpose hardware logic circuits. Alternatively, the control unit and the method thereof described in the present disclosure may be implemented by one or more special-purpose computers, which are constituted by a combination of a processor and a memory programmed to perform one or more functions and a processor constituted by one or more hardware logic circuits. In addition, the computer program may also be stored in a computer-readable non-temporary tangible storage medium as an instruction executed by a computer.
[0077] Although the present disclosure is described based on the embodiments, it should be understood that the present disclosure is not limited to the above-mentioned embodiments and structures. The present disclosure also includes various modifications and modifications within the equivalent range. In addition, various combinations and methods, and other combinations and methods containing only one element, above or below them, also belong to the scope and thought range of the present disclosure.
[0078] The following describes technical ideas extracted from the above-mentioned embodiments. [Structure 1] A vehicle control device is a control device (40, 100) suitable for a vehicle (10) including a pair of drive wheels (21, 22), the pair of drive wheels being installed at two positions on the left and right relative to the vehicle's traveling direction, and each having a motor (23, 24) and each of which is driven independently. The control device controls the travel of the vehicle by controlling the driving of each of the driving wheels, and the vehicle control device includes: a rotation control unit configured to control a rotation speed of each of the drive wheels when the vehicle is traveling; a turning state determination unit for determining a deviation of an actual turning radius from a target turning radius when the vehicle is turning; and An adjustment unit that adjusts a rotation speed of each of the drive wheels by the rotation control unit based on the deviation of the turning radius. [Structure 2] The vehicle control device according to structure 1, wherein: comprising a weight determination unit, the weight determination unit acquiring the weight of the vehicle and determining whether the weight is heavier than a predetermined reference weight, When the adjustment unit determines that there is a deviation in the turning radius, if it is determined that the weight is heavier than the reference weight, the turning speed of the vehicle is controlled by adjusting the rotation speed of each of the drive wheels; if it is determined that the weight is lighter than the reference weight, the difference between the rotation speeds of the pair of drive wheels is controlled. [Structure 3] The vehicle control device according to structure 1 or 2, wherein: The vehicle control device is suitable for a vehicle driving system in which the vehicle is driven in a predetermined driving path. The vehicle comprises a turning radius determination unit, wherein the turning radius determination unit determines whether the target turning radius of the corner portion in the driving path is greater than a predetermined reference radius. When the adjustment unit determines that there is a deviation in the turning radius, if it is determined that the target turning radius is greater than the reference radius, the turning speed of the vehicle is controlled by adjusting the rotation speed of each of the drive wheels; if it is determined that the target turning radius is less than the reference radius, the difference between the rotation speeds of the pair of drive wheels is controlled. [Structure 4] A vehicle control device according to structure 2 or 3, wherein: The turning state determination unit determines whether the actual turning radius is larger or smaller than the target turning radius when the actual turning radius deviates from the target turning radius. When the adjustment unit controls the turning speed of the vehicle by adjusting the rotation speed of each of the driving wheels, if it is determined that the actual turning radius is larger than the target turning radius, the adjustment unit reduces the rotation speed of each of the driving wheels to reduce the turning speed of the vehicle, and if it is determined that the actual turning radius is smaller than the target turning radius, the adjustment unit increases the rotation speed of each of the driving wheels to increase the turning speed of the vehicle. When controlling the difference in rotational speed of the pair of drive wheels, if it is determined that the actual turning radius is larger than the target turning radius, the difference in rotational speed of the pair of drive wheels is increased; if it is determined that the actual turning radius is smaller than the target turning radius, the difference in rotational speed of the pair of drive wheels is reduced. [Structure 5] A vehicle control device according to any one of Structures 1 to 4, wherein: The adjustment unit calculates a first adjustment amount for adjusting the rotation speed of each of the drive wheels based on the deviation amount of the turning radius and the weight of the vehicle when it is determined that the turning radius has deviated, and calculates a second adjustment amount for adjusting the rotation speed of each of the drive wheels based on the deviation amount of the turning radius and the target turning radius. The rotation speed of each of the drive wheels is adjusted using the larger one of the first adjustment amount and the second adjustment amount. [Structure 6] A vehicle control device according to any one of Structures 1 to 5, wherein: An adjustment command unit is included for instructing to adjust the wheel gauge which is the interval between the pair of driving wheels or the wheelbase between the wheels arranged at the front and rear sides in the traveling direction when the deviation of the turning radius exceeds a predetermined threshold value.
Claims
1. A vehicle control device, the vehicle control device being applicable to a vehicle (10) comprising a pair of drive wheels (21, 22), the pair of drive wheels being installed at two positions forming left and right positions with respect to a traveling direction of the vehicle, and each having a motor (23, 24) and each of which is driven independently, The vehicle control device is a control device (40, 100) that controls the travel of the vehicle by controlling the driving of each of the driving wheels, and the vehicle control device includes: a rotation control unit configured to control a rotation speed of each of the drive wheels when the vehicle is traveling; a turning state determination unit for determining a deviation of an actual turning radius from a target turning radius when the vehicle is turning; as well as An adjustment unit adjusts a rotation speed of each of the drive wheels achieved by the rotation control unit based on the deviation of the turning radius.
2. The vehicle control device according to claim 1, characterized in that: A weight determination unit is included, wherein the weight determination unit acquires the weight of the vehicle and determines whether the weight is heavier than a predetermined reference weight. When the adjustment unit determines that there is a deviation in the turning radius, if it is determined that the weight is heavier than the reference weight, the turning speed of the vehicle is controlled by adjusting the rotation speed of each of the drive wheels; if it is determined that the weight is lighter than the reference weight, the difference between the rotation speeds of the pair of drive wheels is controlled.
3. The vehicle control device according to claim 1, characterized in that: The vehicle control device is suitable for a vehicle driving system in which the vehicle drives in a predetermined driving path. The invention comprises a turning radius determination unit, wherein the turning radius determination unit determines whether the target turning radius of the corner portion in the driving path is greater than a predetermined reference radius. When the adjustment unit determines that there is a deviation in the turning radius, if it is determined that the target turning radius is greater than the reference radius, the adjustment unit controls the turning speed of the vehicle by adjusting the rotation speed of each of the driving wheels; if it is determined that the target turning radius is less than the reference radius, the adjustment unit controls the difference in rotation speed of the pair of driving wheels.
4. The vehicle control device according to claim 2 or 3, characterized in that: The turning state determination unit determines whether the actual turning radius is larger or smaller than the target turning radius when the actual turning radius deviates from the target turning radius. When the adjustment unit controls the turning speed of the vehicle by adjusting the rotation speed of each of the driving wheels, if it is determined that the actual turning radius is larger than the target turning radius, the adjustment unit reduces the rotation speed of each of the driving wheels to reduce the turning speed of the vehicle, and if it is determined that the actual turning radius is smaller than the target turning radius, the adjustment unit increases the rotation speed of each of the driving wheels to increase the turning speed of the vehicle. When controlling the difference in rotational speeds of the pair of drive wheels, the adjustment unit increases the difference in rotational speeds of the pair of drive wheels if it is determined that the actual turning radius is larger than the target turning radius, and decreases the difference in rotational speeds of the pair of drive wheels if it is determined that the actual turning radius is smaller than the target turning radius.
5. The vehicle control device according to claim 1, characterized in that: The adjustment unit calculates a first adjustment amount for adjusting the rotation speed of each of the drive wheels based on the deviation amount of the turning radius and the weight of the vehicle when it is determined that the turning radius has deviated, and calculates a second adjustment amount for adjusting the rotation speed of each of the drive wheels based on the deviation amount of the turning radius and the target turning radius. The rotation speed of each of the drive wheels is adjusted using the larger one of the first adjustment amount and the second adjustment amount.
6. The vehicle control device according to claim 1, characterized in that: An adjustment command unit is included for instructing, when the deviation of the turning radius exceeds a predetermined threshold, to adjust a wheel gauge which is the interval between the pair of driving wheels or a wheelbase between wheels arranged at the front and rear sides in the traveling direction.
7. A program, the program being applied to a vehicle (10) comprising a pair of drive wheels (21, 22), the pair of drive wheels being installed at two positions forming left and right positions with respect to a traveling direction of the vehicle, and each having a motor (23, 24) and each of which is driven independently, The program can be executed by a control device (40, 100) to control the driving of each of the driving wheels to control the travel of the vehicle. The procedures include: a rotation control step of controlling a rotation speed of each of the drive wheels when the vehicle is traveling; A turning state determination step of determining a deviation of an actual turning radius from a target turning radius when the vehicle is turning; as well as A step of adjusting the rotation speed of each of the drive wheels achieved by the rotation control step based on the deviation of the turning radius.
