MOBILE OBJECT CONTROL SYSTEM
20250258502 ยท 2025-08-14
Assignee
Inventors
Cpc classification
G05D2109/135
PHYSICS
International classification
Abstract
The processor of the mobile object control system calculates the target speed of the mobile object on the basis of the first operation amount for each individual operation terminal, calculates the target turning angular speed of the mobile object on the basis of the second operation amount for each individual operation terminal, combines the target speed calculated for each individual operation terminal at the first ratio to calculate the final target speed, combines the target turning angular speed calculated for each individual operation terminal at a second ratio different from the first ratio to calculate the final target turning angular speed, and controls one or a plurality of actuators related to the traveling of the mobile object on the basis of the final target speed and the final target turning angular speed.
Claims
1. A mobile object control system configured to control traveling of a mobile object based on operation amount information of a plurality of operation terminals operated by a plurality of operators, respectively, the mobile object control system comprising one or more processors, wherein the operation amount information includes a first operation amount and a second operation amount as operation amounts of each of the operation terminals, and the one or more processors are configured to: calculate, for the individual operation terminals, target speeds that are target values of a speed in a traveling direction of the mobile object based on the first operation amount; calculate, for the individual operation terminals, target turning angular velocities that are target values of a turning angular velocity of the mobile object based on the second operation amount; calculate a final target speed by combining the target speeds calculated for the individual operation terminals at a first ratio; calculate a final target turning angular velocity by combining the target turning angular velocities calculated for the individual operation terminals at a second ratio different from the first ratio; and control one or more actuators related to the traveling of the mobile object based on the final target speed and the final target turning angular velocity.
2. The mobile object control system according to claim 1, wherein: the operation terminals include a first operation terminal and a second operation terminal; a coefficient of the first ratio for multiplication of the target speed based on the first operation amount of the first operation terminal is larger than a coefficient of the first ratio for multiplication of the target speed based on the first operation amount of the second operation terminal; and a coefficient of the second ratio for multiplication of the target turning angular velocity based on the second operation amount of the first operation terminal is equal to a coefficient of the second ratio for multiplication of the target turning angular velocity based on the second operation amount of the second operation terminal.
3. The mobile object control system according to claim 2, wherein: the coefficient of the first ratio for multiplication of the target speed based on the first operation amount of the first operation terminal is 1; and the coefficient of the first ratio for multiplication of the target speed based on the first operation amount of the second operation terminal is 0.
4. A mobile object control system configured to control traveling of a mobile object based on operation amount information of a plurality of operation terminals operated by a plurality of operators, respectively, the mobile object control system comprising one or more processors, wherein the operation amount information includes a first operation amount and a second operation amount as operation amounts of each of the operation terminals, and the one or more processors are configured to: calculate a first combined operation amount by combining the first operation amounts of the individual operation terminals at a first ratio; calculate a second combined operation amount by combining the second operation amounts of the individual operation terminals at a second ratio different from the first ratio; calculate a final target speed that is a target value of a speed in a traveling direction of the mobile object based on the first combined operation amount; calculate a final target turning angular velocity that is a target value of a turning angular velocity of the mobile object based on the second combined operation amount; and control one or more actuators related to the traveling of the mobile object based on the final target speed and the final target turning angular velocity.
5. The mobile object control system according to claim 4, wherein: the operation terminals include a first operation terminal and a second operation terminal; a coefficient of the first ratio for multiplication of the first operation amount of the first operation terminal is larger than a coefficient of the first ratio for multiplication of the first operation amount of the second operation terminal; and a coefficient of the second ratio for multiplication of the second operation amount of the first operation terminal is equal to a coefficient of the second ratio for multiplication of the second operation amount of the second operation terminal.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0022] Features, advantages, and technical and industrial significance of exemplary embodiments of the disclosure will be described below with reference to the accompanying drawings, in which like signs denote like elements, and wherein:
[0023]
[0024]
[0025]
[0026]
[0027]
[0028]
[0029]
[0030]
DETAILED DESCRIPTION OF EMBODIMENTS
[0031] Embodiments of the present disclosure will be described with reference to the accompanying drawings. In the drawings, the same reference numerals are assigned to the same elements, and redundant descriptions are omitted or simplified.
1. Mobile Object Control System
[0032]
[0033] Each of the terminals 10 and 20 is operated by two operators 1 and 2 (see
[0034] Specifically, the terminal 10 includes, for example, a touch panel 11, a communication device 12, a processor 13, a storage device 14, and sensors 15. The touch panel 11 is formed on one plate surface of the first terminal 10 and includes a display screen and a touch sensor. The touch sensor is configured to be able to detect a touch of an operator on a display screen. The communication device 12 performs wireless communication with the mobile object 30. Although the shape of the terminal 10 is not particularly limited, for example, the terminal 10 is formed in a plate shape (for example, a rectangular plate shape) in which one side is a short side direction and the other side is a longitudinal direction (see
[0035] The processor (processing circuit) 13 executes various processes for controlling the travel of the mobile object 30. The storage device 14 stores various kinds of information necessary for processing by the processor 13. More specifically, the processor 13 executes various processes by using various programs related to travel control of the mobile object 30. The various programs may be stored in the storage device 14 or may be recorded in a computer-readable recording medium. The sensors 15 include, for example, an inclination angle sensor and a position sensor. The inclination angle sensor detects an inclination direction and an inclination angle (posture) of the first terminal 10. The inclination angle sensor includes, for example, a six-axis gyro sensor. The tilt angle of the terminal 10 is used for the travel control of the mobile object 30 using the tilt operation O described later. The position sensor includes a GNSS (Global Navigation Satellite System) receiver and detects a position and an orientation of the first terminal 10.
[0036] Like the terminal 10, the terminal 20 includes a touch panel 21, a communication device 22, a processor 23, a storage device 24, and sensors 25.
[0037]
[0038] The mobile object 30 is an open type small mobility capable of being ridden by two persons. The mobile object 30 includes a vehicle body 31 and a chassis 32. The vehicle body 31 has a seating 31a for two passengers. As shown in
[0039] The chassis 32 includes a circular frame 33. Two drive wheels (left and right front wheels) 34R, a 34L, and one driven wheel (rear wheel) 35 are attached to the frame 33. The drive wheels 34R and 34L are arranged opposite each other and are respectively rotationally driven by the electric motors 36R and 36L. The driven wheel 35 is an omni-wheel (for example, an omni-wheel (registered trademark)).
[0040] The mobile object 30 further includes a communication device 37, an electronic control unit (ECU) 38, and sensors 39. The communication device 37 performs wireless communication with the first and second terminals 10 and 20.
[0041] ECU 38 controls the traveling of the mobile object 30. ECU 38 includes a processor 40 and a storage device 41. The processor 40 executes various processes related to travel control of the mobile object 30. The storage device 41 stores various kinds of information necessary for processing by the processor 40. More specifically, the processor 40 executes various processes using various programs related to travel control of the mobile object 30. The various programs may be stored in the storage device 41 or may be recorded in a computer-readable recording medium.
[0042] The sensors 39 include, for example, a recognition sensor, a moving object state sensor, and a position sensor. The recognition sensor recognizes a situation around the mobile object 30. Examples of recognition sensors include cameras, LIDAR (Laser Imaging Detection and Ranging), radars, and the like. The mobile object state sensor detects a state of the mobile object 30. The moving body state sensor includes, for example, a speed sensor that detects the speed V and a turning angular speed sensor that detects the turning angular speed . The position sensor detects the position and the azimuth of the mobile object 30. For example, the position sensor includes a GNSS receiver.
[0043] As shown in
[0044] As can be seen from the relations of equations (1) and (2), ECU 38 can cause the mobile object 30 to travel straight along the traveling direction by controlling the two electric motors 36R and 36L such that the velocity V.sub.R and the velocity V.sub.L are equal. ECU 38 can then accelerate and decelerate the mobile object 30 by controlling the two electric motors 36R and 36L. In addition, ECU 38 can turn the mobile object 30 to the left and right by controlling the two electric motors 36R and 36L to provide a difference between the velocity V.sub.R and the velocity V.sub.L.
[0045] In addition, the plurality of operation terminals according to the present disclosure is not limited to a portable terminal such as a smartphone, and may be a terminal using another operation method such as a joystick. In addition, the mobile object according to the present disclosure is not limited to the mobile object 30 shown in
2. Travel Control of Mobile Object
[0046] The mobile object control system 100 is configured to control the traveling of the mobile object 30 based on the operation amount information I of the plurality of operation terminals (terminals 10 and 20). More specifically, the mobile object control system 100 controls the speed V and the turning angular speed of the mobile object 30 based on the operation amount information I. That is, the speed V and the turning angular velocity correspond to a control amount for controlling the travel of the mobile object 30.
[0047] The mobile object control system 100 uses the operation amount information I when the tilt operation O of each of the terminals 10 and 20 is performed in order to control each of the speed V and the turning angular velocity . The tilt operation O is an operation of tilting the terminals 10 and 20 by the operators 1 and 2.
[0048]
[0049] In the exemplary embodiment illustrated in
[0050] Here, it is assumed that the tilt angle A.sub.1 is zero when a predetermined reference state (for example, a state in which the center line L.sub.B is horizontal) is satisfied. Then, the tilt angle A.sub.1 becomes positive when the operator 1 tilts the terminal 10 so that the end 10e1 of the terminal 10 farther from the operator 1 with respect to the reference condition is lowered. It is assumed that the tilt angle A.sub.1 is negative when the operator 1 tilts the terminal 10 so that the end 10e1 increases with respect to the reference condition. This also applies to the tilt angle A.sub.2 of the terminal 20.
[0051] Further, it is assumed that the tilt angle B.sub.1 is zero when a predetermined reference state (for example, a state in which the center line L.sub.A is horizontal) is satisfied. Then, it is assumed that the tilt angle B.sub.1 is positive when the operator 1 tilts the terminal 10 so that the left end 10e2 of the operator 1 is lowered with respect to the reference state, and is negative when the operator 1 tilts the terminal 10 so that the end 10e2 is raised with respect to the reference state. This also applies to the tilt angle B.sub.2 of the terminal 20.
[0052]
[0053] The operation amount acquisition unit 51 of the terminal 10 acquires the tilt angle A.sub.1 and the B.sub.1 detected by the tilt angle sensor included in the sensors 15. Similarly, the operation amount acquisition unit 61 of the terminal 20 acquires the tilt angle A.sub.2 and the B.sub.2 detected by the tilt angle sensor included in the sensors 25. The tilt angle A.sub.1, B.sub.1, A.sub.2, and B.sub.2 may, for example, be between 180 and 180.
[0054] The control amount calculation unit 52 of the terminal 10 calculates a target velocity V.sub.1 (target control amount). Specifically, the storage device 14 of the terminal 10 stores a of map MV.sub.1 that defines the relation between the tilt angle A.sub.1 and the target velocity V.sub.1. The map MV.sub.1 is set such that, for example, when the tilt angle A.sub.1 is zero, the target velocity V.sub.1 also becomes zero, and the target velocity V.sub.1 becomes higher as the positive tilt angle A.sub.1 becomes larger. The control amount calculation unit 52 calculates a target velocity V.sub.1 corresponding to the acquired tilt angle A.sub.1 from the map MV.sub.1. In addition, the storage device 24 of the terminal 20 stores a map MV.sub.2 that determines the relation between the tilt angle A.sub.2 and the target velocity V.sub.2 based on the same concept as the map MV.sub.1. The control amount calculation unit 62 calculates the target velocity V.sub.2 corresponding to the acquired tilt angle A.sub.2 from the map MV.sub.2.
[0055] The control amount calculation unit 52 of the terminal 10 calculates the target turning angular velocity .sub.1 (target control amount). Specifically, the storage device 14 also stores a map M.sub.1 that defines the relation between the tilt angle B.sub.1 and the target turning angular velocity .sub.1. The map M.sub.1 is set such that the target turning angular velocity .sub.1 is also zero when the tilt angle B.sub.1 is zero, for example. The map M.sub.1 is set such that, for example, the positive target turning angular velocity .sub.1 increases as the positive tilt angle B.sub.1 increases, and the negative target turning angular velocity .sub.1 increases as the negative tilt angle B.sub.1 increases. The control amount calculation unit 52 calculates a of the target turning angular velocity .sub.1 corresponding to the obtained tilt angle B.sub.1 from the map M.sub.1. In the storage device 24 of the terminal 20, a map M.sub.2 in which the relation between the tilt angle B.sub.2 and the target turning angular velocity .sub.2 is determined based on the same concept as the map M.sub.1 is stored. The control amount calculation unit 62 calculates 2 of the target turning angular velocity .sub.2 corresponding to the obtained tilt angle B.sub.2 from the map M.sub.2.
[0056] The target velocity V.sub.1 and V.sub.2 and the target turning angular velocity .sub.1 and .sub.2 calculated in the terminals 10 and 20 as described above are transmitted to the mobile object 30.
[0057] The control amount arbitration unit 71 of the mobile object 30 arbitrates the target velocities V.sub.1 and V.sub.2 received from the terminals 10 and 20, respectively. Specifically, the control amount arbitration unit 71 combines the target velocities V.sub.1 and V.sub.2 calculated for each of the terminals 10 and 20 at the first ratio to calculate the final target velocity V.sub.t. The final target velocity V.sub.t is expressed, for example, by Equation (3). The first ratio is specified by the coefficients C.sub.1 and C.sub.2. That is, the C.sub.1 is a factor indicating the first ratio of the target velocity V.sub.1 and is multiplied by the target velocity V.sub.1. The C.sub.2 is a factor indicating the first ratio of the target velocity V.sub.2 and is multiplied by the target velocity V.sub.2. The final target velocity V.sub.t corresponds to the product of the coefficient C.sub.1 and the target velocity V.sub.1and the product of the coefficient C.sub.2 and the target velocity V.sub.2. In an example in which three or more operation terminals are used, three or more target speeds V.sub.i corresponding to three or more first operation amounts are synthesized by the first ratio.
[0058] The control amount arbitration unit 71 arbitrates the target turning angular velocities .sub.1 and .sub.2 received from the terminals 10 and 20, respectively. Specifically, the control amount arbitration unit 71 combines the target turning angular velocities .sub.1 and .sub.2calculated for each of the terminals 10 and 20 at the second ratio to calculate the final target turning angular velocity .sub.t. The second ratio differs from the first ratio as illustrated in
[0059] The first and second ratios can be set by the operator 1 operating the touch panel 11 of the terminal 10. More specifically, for example, the terminal 10 may be able to set only the coefficients C.sub.1 and D.sub.1 associated with the operation of the terminal 10, or may be able to set the coefficients C.sub.2 and D.sub.2 associated with the operation of the other terminal 20. This also applies to the terminal 20.
[0060] The first and second ratios may be arbitrarily set on condition that they are different from each other. In addition,
[0061] In the embodiment shown in
[0062] On the other hand, the second ratio with respect to the final target turning angular velocity t is set such that the coefficient D.sub.1 of the terminal 10 is equal to the coefficient D.sub.2 of the terminal 20. More specifically, for example, the coefficient D.sub.1 is set to 0.5, and the coefficient D.sub.2 is set to 0.5. According to this setting example, in order to control the turning angular velocity , the two operators 1 and 2 are required to operate the terminals 10 and 20 together with the rhythm.
[0063] In addition, in each of the first and second ratios, the sum of the two coefficients (e.g., C.sub.1+C.sub.2, D.sub.1+D.sub.2) is basically 1 as shown in the example in
[0064] The motor control unit 72 controls the two electric motors 36L and 36R so that the calculated final target velocity Vt and final target turning angular speed t are realized. More specifically, the motor control unit 72 substitutes the final target velocity Vt and the final target turning angular speed t into the speed V and the turning angular speed in Equations (1) and (2), respectively, to calculate the target velocities V.sub.Lt and V.sub.Rt of the two drive wheels 34L and 34R, respectively. The motor control unit 72 controls the electric motor 36L and 36R so that the target velocities V.sub.Lt and V.sub.Rt are realized. Note that the electric motor 36L and 36R correspond to an exemplary one or more actuators related to traveling of a moving object according to the present disclosure.
[0065] According to the mobile object control system 100 according to the present embodiment described above, the first and second ratios that differ from each other are used in the calculation of the final target velocity Vt and the final target turning angular speed t, which are two target values for the travel control of the mobile object 30. Consequently, the ratio in which the first and second manipulated variables of the individual operation terminals 10 and 20 are reflected differs between the final target velocity Vt and the final target turning angular velocity t (see Equations (3) and (4)). This means that the degree of involvement of the two operators 1, 2 with respect to the travel control of the mobile object 30 differs between the final target velocity Vt and the final target turning angular speed t. In other words, this allows the two operators 1 and 2 to have different roles in units of the control amount of the mobile object 30, namely, the speed V and the turning angular velocity . This leads to the fact that the pleasure of operating the mobile object 30 in cooperation can be easily shared between the two operators 1 and 2.
[0066] In addition, the mobile object 30 shown in
[0067] Further, as illustrated in
[0068] In addition, according to the above setting example of the first and second ratios, when the mobile object 30 is boarded by the parent and the child, the parent operates the terminal 10 and the child operates the terminal 20. As a result, the child can enjoy the operation related to the turning of the mobile object 30 together with the parent while the parent safely manages the speed V.
3. Another Configuration Example of Mobile Object Control System
[0069] The mobile object control system according to the present disclosure may include the configuration shown in
[0070]
[0071] In the example illustrated in
[0072] The mobile object control system 200 described above also provides effects similar to those described above for the mobile object control system 100.
[0073]
[0074] In the embodiment illustrated in
[0075] The operation amount arbitration unit 75 of the mobile object 30 arbitrates the tilt angle B.sub.1 and B.sub.2 received from the terminals 10 and 20, respectively. Specifically, the operation amount arbitration unit 75 combines the tilt angle B.sub.1 and B.sub.2 at the second ratio to calculate the post-arbitration operation amount (second combination operation amount) B.sub.x. The post-arbitration operation amount B.sub.x is expressed, for example, by Equation (6). That is, the post-arbitration operation amount B.sub.x corresponds to the product of the coefficient D.sub.1 and the tilt angle B.sub.1 and the product of the coefficient D.sub.2 and the tilt angle B.sub.2. In an example in which three or more operation terminals are used, three or more second operation amounts are combined by a second ratio.
[0076] In addition, even in the example shown in
[0077] The final control amount calculation unit 76 calculates the final target velocity V.sub.t corresponding to the post-arbitration operation amount A.sub.x inputted from the operation amount arbitration unit 75 from the map MV.sub.t. The map MV.sub.t defines the relation between the post-arbitration operation amount A.sub.x and the final target velocity V.sub.t based on the same concept as the above-described map MV.sub.1, and is stored in the storage device 34. Further, the final control amount calculation unit 76 calculates the final target turning angular velocity .sub.t corresponding to the post-arbitration operation amount B.sub.x input from the operation amount arbitration unit 75 from the map M.sub.t. The map M.sub.t defines the relation between the post-arbitration operation amount B.sub.x and the final target turning angular velocity .sub.t based on the same concept as the map M.sub.1 described above, and is stored in the storage device 34. The calculated final target velocity V.sub.t and the final target turning angular speed .sub.t are input to the motor control unit 72.
[0078] The mobile object control system 300 described above also provides effects similar to those described above for the mobile object control system 100.
[0079] In addition, the configuration shown in