System for calculating combination angle between combined vehicle, device for calculating combination angle between combined vehicle and method for calculating combination angle between combined vehicle
The coupling angle calculation system uses a link mechanism with detection sensors to simplify the installation process and enhance accuracy in detecting the coupling angle between towing and towed vehicles, improving safety by providing real-time feedback.
Patent Information
- Application Number
- JP2023078349
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2023-05-11
- Publication Date
- 2024-11-21
AI Technical Summary
Existing coupling angle detection systems for towed vehicles require complex and time-consuming installation of reflectors and scan radars, leading to inefficiencies in detecting the coupling angle between towing and towed vehicles.
A coupling angle calculation system utilizing a link mechanism with link members and joint members connected to both vehicles, equipped with link detection sensors to accurately detect the coupling angle through a simple installation process, which can include serial or parallel link mechanisms and uses existing vehicle components like cables for communication.
Enables accurate detection of the coupling angle with minimal installation effort, enhancing safety by providing real-time feedback to drivers to avoid jackknifing and improve maneuverability.
Smart Images

Figure 2024162633000001_ABST
Abstract
Description
[Technical field]
[0001] The present disclosure relates to a system for calculating a coupling angle of an articulated vehicle, a device for calculating a coupling angle of an articulated vehicle, and a method for calculating a coupling angle of an articulated vehicle. [Background technology]
[0002] Conventionally, towing vehicles, which are articulated vehicles, have been used as vehicles for transporting cargo such as containers in large facilities such as port facilities. A towing vehicle is a vehicle in which a towing vehicle (trailer head or tractor) and a towed vehicle (trailer) towed by the towing vehicle are connected by a coupling mechanism. The coupling mechanism of this towing vehicle is composed of a coupler on the towing vehicle side and a kingpin on the towed vehicle side.
[0003] When a towing vehicle configured in this manner turns left or right, the coupling angle becomes large. When the coupling angle becomes large, there is a risk of the vehicle becoming unable to travel due to a jackknife phenomenon or other such condition, and the driver has difficulty in grasping the area in which the vehicle body is moving, so the driver must drive with even greater caution. In view of this, there is a technology that detects the coupling angle between the towing vehicle and the towed vehicle while the towing vehicle is traveling, and provides driving assistance based on the detected value (see Patent Document 1). [Prior art documents] [Patent documents]
[0004] [Patent Document 1] JP 2002-114176 A Summary of the Invention [Problem to be solved by the invention]
[0005] Patent Document 1 describes a trailer coupling angle calculation device in which a reflector is installed at a predetermined position on the towed vehicle, and a scan radar installed on the towing vehicle scans the towed vehicle horizontally and detects the direction of the reflected light returning from the reflector, thereby detecting the coupling angle of the towed vehicle relative to the towing vehicle.
[0006] However, when using the technique described in Patent Document 1, adjustment of the installation positions of the reflector and the scan radar is required when installing them, which is troublesome.
[0007] The present disclosure has been made in consideration of the above-mentioned circumstances, and has an object to provide a coupling angle calculation system for articulated vehicles, a coupling angle calculation device for articulated vehicles, and a coupling angle calculation method for articulated vehicles that are capable of detecting the coupling angle of two vehicles that make up an articulated vehicle with high accuracy using simple processing. [Means for solving the problem]
[0008] The coupling angle calculation system for coupled vehicles according to the present disclosure includes a link structure constituted by a plurality of link members and joint members that connect the plurality of link members to form a link mechanism, the link structure having both ends connected to a first vehicle and a second vehicle coupled to the first vehicle, a link detection sensor that detects at least one of a direction or a position of the link members, and a coupling angle calculation device that calculates the coupling angle between the first vehicle and the second vehicle based on information on the direction or position of the link members detected by the link detection sensor.
[0009] The link structure may be configured as a serial link mechanism or a parallel link mechanism.
[0010] The link members of the link structure may be configured so that their direction or position can be changed by a rotational movement or an expansion / contraction movement about an axis in a predetermined direction.
[0011] The link detection sensor may be operated using power supplied from the first vehicle or the second vehicle to which it is connected.
[0012] In addition, the link structure may be installed along a cable that communicates information between a predetermined position of the first vehicle and a predetermined position of the second vehicle, or may be configured by installing the cable inside.
[0013] Moreover, one end of the link structure may be connected to a connector in the second vehicle to which a cable for communicating with the first vehicle is connected.
[0014] The link detection sensor may detect at least one of a direction and a position of the link member by using a signal transmitted from the first vehicle to the second vehicle.
[0015] Furthermore, a coupling angle calculation device for coupled vehicles according to the present disclosure is constituted by a plurality of link members and joint members that connect the plurality of link members to form a link mechanism, and includes a coupling angle calculation unit that is communicatively connected at both ends to link detection sensors that detect at least one of a direction or a position of the link members within link structures respectively connected to a first vehicle and a second vehicle coupled to the first vehicle, and calculates the coupling angle between the first vehicle and the second vehicle based on information on the direction or position of the link members detected by the link detection sensors.
[0016] The present disclosure also provides a method for calculating a link angle of an articulated vehicle, the method comprising: a link structure including a plurality of link members and joint members that connect the plurality of link members to form a link mechanism, the link structure having both ends connected to a first vehicle and a second vehicle connected to the first vehicle, the link angle calculation device being communicatively connected to a link detection sensor that detects at least one of a direction or a position of the link members; A connection angle between the first vehicle and the second vehicle is calculated based on information on the direction or position of the link member detected by the link detection sensor. Effect of the Invention
[0017] According to the articulated vehicle connection angle calculation system, articulated vehicle connection angle calculation device, and articulated vehicle connection angle calculation method disclosed herein, the connection angle of two vehicles that make up the articulated vehicle can be detected with high accuracy using simple processing. [Brief description of the drawings]
[0018] [Figure 1] FIG. 1 is a block diagram showing a configuration of a connection angle calculation system according to an embodiment. [Diagram 2] FIG. 2 is a side view of a link structure 20A, which is one form of the link structure 20 in the connection angle calculation system according to one embodiment, installed on a towing vehicle 10. [Diagram 3] FIG. 2 is a side view of a link structure 20B, which is one form of the link structure 20 in the connection angle calculation system according to one embodiment, installed on a towing vehicle 10. [Figure 4] FIG. 2 is a side view of a link structure 20C, which is one form of the link structure 20 in the connection angle calculation system according to one embodiment, installed on a towing vehicle 10. [Diagram 5] FIG. 13 is a side view of a link structure 20D, which is one form of the link structure 20 in the connection angle calculation system according to one embodiment, installed on a towing vehicle 10. [Figure 6] 4 is a flowchart showing a connection angle calculation process executed by a connection angle calculation device 40 in a connection angle calculation system according to one embodiment. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0019] An embodiment of a coupling angle calculation device that detects the coupling angle of a towing vehicle, which is a coupled vehicle, will be described below with reference to the drawings. A towing vehicle is a vehicle in which a towing vehicle (trailer head or tractor) and a towed vehicle (trailer) towed by the towing vehicle are coupled by a coupling mechanism. The coupling mechanism of the towing vehicle is composed of a coupler on the towing vehicle side and a kingpin on the towed vehicle side, and the coupling angle changes depending on, for example, the change in the traveling direction of the towing vehicle.
[0020] 1 is a block diagram showing the configuration of a connection angle calculation system 1 according to one embodiment. The connection angle calculation system 1 includes a link structure 20 installed on a towing vehicle 10, an angle sensor 30 as a link detection sensor installed on the link structure 20, and a connection angle calculation device 40.
[0021] Below, configuration examples (1) to (4) of the towing vehicle 10, the link structure 20, and the angle sensor 30 will be explained.
[0022] [Configuration example (1)] FIG. 2 is a side view of a link structure 20A, which is one embodiment of the link structure 20, installed on the towing vehicle 10. As shown in FIG.
[0023] The towing vehicle 10 is configured by connecting a towing vehicle 11, which is a first vehicle, and a towed vehicle 12, which is a second vehicle, with a connecting member 13. The towing vehicle 11 is equipped with an on-board unit 111 and an automatic driving control device 112 connected to the on-board unit 111. A connector 14 is installed on the towed vehicle 12, and the connector 14 and the on-board unit 111 are connected with a cable 15. The cable 15 transmits information such as a CAN (Controller Area Network) signal, a brake signal, and a turn signal signal transmitted from the on-board unit 111 to the towed vehicle 12. These signals are used to turn on lamps (not shown) in the towed vehicle 12 as appropriate.
[0024] The link structure 20A has link members 21a, 21b, 21c, 21d, 21e, 21f, and 21g, and joint members 22a, 22b, 22c, 22d, 22e, and 22f.
[0025] The link members 21a and 21b are connected to the joint member 22a in a state in which they can rotate up and down around a pitch axis that is horizontal to the ground as a rotation axis. The link members 21b and 21c are connected to the joint member 22b in a state in which they can rotate left and right around a yaw axis that is vertical to the ground as a rotation axis. The link members 21c and 21d are connected to the joint member 22c in a state in which they can rotate up and down around a pitch axis as a rotation axis. The link members 21d and 21e are connected to the joint member 22d in a state in which they can rotate left and right around a yaw axis as a rotation axis. The link members 21e and 21f are connected to the joint member 22e in a state in which they can rotate up and down around a pitch axis as a rotation axis. The link members 21f and 21g are connected to the joint member 22f in a state in which they can rotate left and right around a yaw axis as a rotation axis.
[0026] In this manner, the link structure 20A of the serial link mechanism is formed by connecting the various members successively in the following order: link member 21a-joint member 22a-link member 21b-joint member 22b-link member 21c-joint member 22c-link member 21d-joint member 22d-link member 21e-joint member 22e-link member 21f-joint member 22f-link member 21g.
[0027] Link structure 20A has one end, link member 21a, fixed to a predetermined position within towing vehicle 11, for example, the base position of cable 15, and the other end, link member 21g, fixed to a predetermined position within towed vehicle 12, for example, connector 14. Furthermore, link member 21a to link member 21g are installed so as to run along cable 15. Installing link structure 20A in this manner allows link structure 20A to be installed so as not to interfere with the travel of towing vehicle 10.
[0028] In this way, by using the connector 14 and cable 15, which are existing equipment, the link structure 20A can be installed so as not to impede driving. Also, by configuring the link structure 20A as a serial link mechanism, it becomes easier to install it along the cable 15.
[0029] An angle sensor 30a is installed in the joint member 22b, an angle sensor 30b is installed in the joint member 22d, and an angle sensor 30c is installed in the joint member 22f. In addition, an angle sensor 31a is installed in the joint member 22a, an angle sensor 31b is installed in the joint member 22c, and an angle sensor 31c is installed in the joint member 22e.
[0030] Angle sensor 30a detects the angle between link members 21b and 21c as the orientation of link members 21b and 21d in a plane horizontal to the ground. Angle sensor 30b detects the angle between link members 21d and 21e in a plane horizontal to the ground. Angle sensor 30c detects the angle between link members 21f and 21g in a plane horizontal to the ground.
[0031] Angle sensor 31a detects the angle between link members 21a and 21b as the orientation of link members 21a and 21b in a plane perpendicular to the ground. Angle sensor 31b detects the angle between link members 21c and 21d in a plane perpendicular to the ground. Angle sensor 31c detects the angle between link members 21e and 21f in a plane perpendicular to the ground.
[0032] The angle sensors 30a, 30b, 30c, 31a, 31b, and 31c are connected to the coupling angle calculation device 40 via communication lines or wireless communication, and transmit detected angle information to the coupling angle calculation device 40. With this configuration, information on the angles made by the link members 21 connected to each joint member 22a, 22b, 22c, 22d, 22e, and 22f, which change depending on the coupling angle between the towing vehicle 11 and the towed vehicle 12, can be provided to the coupling angle calculation device 40.
[0033] In this configuration example (1), the link member 21 is configured including a joint member that can rotate the link member 21 about the yaw axis and pitch axis as rotation axes, so that it is easy to install according to the installation shape of the cable 15.
[0034] In the above-mentioned configuration example (1), a case has been described in which the end of the link structure 20A is installed at the base position of the cable 15 inside the towing vehicle 11, but this is not limited to this, and the end of the link structure 20A may be installed near a midpoint of the cable 15 inside the towing vehicle 11, etc.
[0035] [Configuration example (2)] 3 is a side view of a link structure 20B, which is one embodiment of the link structure 20, installed on the towing vehicle 10. The link structure 20B has link members 21h, 21i, and 21j, joint members 22g and 22h, and an extension / contraction mechanism 23.
[0036] To calculate the connection angle between the towing vehicle 11 and the towed vehicle 12, it is not necessary to obtain angle information of the link member 21 for all six degrees of freedom of the positions and attitudes of these vehicles, and it is sufficient to obtain angle information in the left-right direction relative to the yaw axis. Therefore, in configuration example (2), the link structure 20B is composed of an extension mechanism 23 that can adjust the height direction, and a link member 21 connected to the joint member 22 with the yaw axis as the rotation axis.
[0037] Link members 21h and 21i are connected to joint member 22g in a state in which they can rotate left and right around the yaw axis. Link members 21i and 21j are connected to joint member 22h in a state in which they can rotate left and right around the yaw axis. In addition, an extension mechanism 23 is connected to link member 21h.
[0038] In this manner, the link structure 20B of the serial link mechanism is formed by successively connecting the respective members and mechanisms in the order of the extension / retraction mechanism 23-link member 21h-joint member 22g-link member 21i-joint member 22h-link member 21j.
[0039] The extension mechanism 23 is installed, for example, on the towing vehicle 11 so as to extend and retract in an axial direction perpendicular to the height direction relative to the ground, and the link member 21j is fixed to a predetermined position in the towed vehicle 12, for example, to the connector 14. Also, the extension mechanism 23 adjusts the height of the link member 21h so that the structure from the link member 21h to the link member 21j is horizontal to the ground and aligned with the cable 15, thereby determining the installation position.
[0040] An angle sensor 30d is installed in the joint member 22g, and an angle sensor 30e is installed in the joint member 22h. The angle sensor 30d detects the angle between the link members 21h and 21i on a plane horizontal to the ground. The angle sensor 30b detects the angle between the link members 21i and 21j on a plane horizontal to the ground.
[0041] The angle sensors 30d and 30e are connected to the coupling angle calculation device 40 via a communication line or wireless communication, and transmit detected angle information to the coupling angle calculation device 40 as angle detection information. With this configuration, information on the angles made by the link members 21 connected to each joint member 22g, 22e, which change depending on the coupling angle between the towing vehicle 11 and the towed vehicle 12, can be provided to the coupling angle calculation device 40 using the simply configured link structure 20B. By configuring the link structure 20 with such a small number of joints, angle information used to calculate the coupling angle between the towing vehicle 11 and the towed vehicle 12 can be detected with high accuracy.
[0042] [Configuration example (3)] 4 is a side view of a link structure 20C, which is one embodiment of the link structure 20, installed on the towing vehicle 10. The link structure 20C has a similar configuration to the link structure 20B of configuration example (2).
[0043] In this embodiment, a rear connector 16 is installed between the towed vehicle 12 and the connector 14, and an end of the link member 21j is sandwiched between the connector 14 and the rear connector 16 and fixed.
[0044] Installing the link structure 20C in this manner makes it easier for the angle sensors 30d, 30e in the link structure 20C to use power supplied from the towing vehicle 11 via the connector 14, or power supplied from the towed vehicle 12 via the retrofit connector 16. Configuring the angle sensors 30d, 30e to operate using power supplied from the towing vehicle 11 or the towed vehicle 12 makes it easier to manage the angle sensors 30d, 30e.
[0045] [Configuration example (4)] 5 is a side view of a link structure 20D, which is one embodiment of the link structure 20, installed on the towing vehicle 10. The link structure 20D has link members 21k, 21m, a joint member 22i, and an extension / contraction mechanism .
[0046] The link members 21k and 21m are connected to the joint member 22i in a state in which they can rotate left and right around the yaw axis as a rotation axis. In this manner, the link structure 20D of the serial link mechanism is formed by connecting the various members and mechanisms in the order of the telescopic mechanism 23-link member 21k-joint member 22i-link member 21m.
[0047] An angle sensor 30f is installed in the joint member 22i. The angle sensor 30f detects the angle between the link members 21k and 21m on a plane horizontal to the ground. An internal cable 24a is passed through the inside of the link member 21k, and an internal cable 24b is passed through the inside of the link member 21m.
[0048] In this embodiment, as in configuration example (3), the retrofit connector 16 is installed on the towed vehicle 12. The extension mechanism 23 is installed, for example, on the towing vehicle 11 so as to be extendable in the height direction perpendicular to the ground, and the link member 21m is fixed to the retrofit connector 16 in the towed vehicle 12. In addition, the extension mechanism 23 adjusts the height of the link member 21h to determine the installation position so that the link member 21k, the joint member 22i, and the link member 21m are horizontal to the ground.
[0049] The connector 14 is installed at a certain position in the link structure 20D, for example, in the extension mechanism 23. That is, the link member k, the joint member 22i, and the link member m, which are parts of the link structure 20D, are sandwiched and fixed between the connector 14 and the retrofit connector 16.
[0050] A CAN (Controller Area Network) signal, a brake signal, a turn signal signal, and the like transmitted from the vehicle-mounted device 111 are received by the towed vehicle 12 via the cable 15, the connector 14, the internal cable 24a, the angle sensor 30f, the internal cable 24b, and the retrofit connector 16. In other words, the link structure 20D relays the transmission and reception of various signals between the vehicle-mounted device 111 and the towed vehicle 12 using the internal cables 24a, 24b.
[0051] By installing the link structure 20D in this manner, the angle sensor 30f can accurately detect the angle using the signal transmitted from the towing vehicle 11 to the towed vehicle 12. For example, when a brake signal is transmitted from the in-vehicle device 111, the angle sensor 30f determines that the towing vehicle 10 has stopped, stops the angle detection process, and outputs the angle detected before the towing vehicle 10 stopped as the current angle.
[0052] By performing processing in this manner, even if there is a change in the angle between link members 21k and 21m due to the swaying of the vehicle body or the like while the towing vehicle 10 is stopped, the connecting angle is not updated, as will be described later, and detection noise can be eliminated.
[0053] The angle sensor 30f is connected to the coupling angle calculation device 40 via a communication line, a connector 14, and a cable 15, or via wireless communication, and transmits detected angle information to the coupling angle calculation device 40 as angle detection information. With these configurations, information on the angle of the link member 21 connected to the joint member 22i, which changes according to the coupling angle between the towing vehicle 11 and the towed vehicle 12, can be provided to the coupling angle calculation device 40 using the simply configured link structure 20D. Furthermore, by integrating the cable that transmits various signals output from the on-board device 111 to the towed vehicle 12 with the link structure 20D, the link structure 20D can be installed so as not to interfere with the travel of the towing vehicle 10. In this embodiment, the cable is passed through the link structure 20D to integrate them.
[0054] Hereinafter, when it is not specified which of the above-mentioned link structures 20A, 20B, 20C, and 20D is used, it will be referred to as the link structure 20. When it is not specified which of the link members 21a, 21b, 21c, 21d, 21e, 21f, 21g, 21h, 21i, 21j, 21k, and 21m is used, it will be referred to as the link member 21. When it is not specified which of the joint members 22a, 22b, 22c, 22d, 22e, 22f, 22g, 22h, and 22i is used, it will be referred to as the joint member 22. When it is not specified which of the angle sensors 30a, 30b, 30c, 30d, 30e, and 30f is used, it will be referred to as the angle sensor 30.
[0055] Returning to FIG. 1, the connection angle calculation device 40 has a CPU 41 and an output unit 42. The CPU 41 (an example of a control unit or processing unit) is a general-purpose computer equipped with an arithmetic unit, a memory, and an input / output unit. A computer program (connection angle calculation program) for causing the CPU 41 to function as a part of the connection angle calculation device is installed in the CPU 41. By executing the computer program, the CPU 41 functions as a plurality of information processing circuits (411, 412) included in the connection angle calculation device.
[0056] Alternatively, the connection angle calculation program may be stored in a computer-readable recording medium such as a HDD, an SSD, a USB memory, a CD, or a DVD. The computer-readable recording medium may be, for example, a non-transitory recording medium. The connection angle calculation program may also be distributed via a communication network.
[0057] In the following, an example is shown in which the multiple information processing circuits (411, 412) included in the connection angle calculation device are realized by software. However, it is also possible to configure the information processing circuits (411, 412) by preparing dedicated hardware for executing each information process described below. Also, the multiple information processing circuits (411, 412) may be configured by individual hardware.
[0058] The CPU 41 has a sensor information acquisition unit 411 and a coupling angle calculation unit 412. The sensor information acquisition unit 411 acquires angle detection information from all angle sensors 30 in the connected link structure 20. The coupling angle calculation unit 412 calculates forward kinematics using the angle detection information acquired by the sensor information acquisition unit 411 to calculate the angle of the connector 14 with respect to the towing vehicle 11, i.e., the coupling angle between the towing vehicle 11 and the towed vehicle 12. The coupling angle is an angle in a plane horizontal to the ground.
[0059] The output unit 42 outputs information about the connection angle calculated by the connection angle calculation unit 412 to the automatic driving control device 112 or a display device (not shown) that is visually recognized by the driver.
[0060] 6 is a flowchart showing the process of calculating the connection angle executed by the connection angle calculation device 40. When the towing vehicle 10 starts driving ("YES" in S1), the connection angle calculation device 40 acquires angle detection information transmitted from each connected angle sensor 30 (S2).
[0061] The coupling angle calculation device 40 calculates forward kinematics using the angle detection information acquired by the sensor information acquisition unit 411, and, for example, by determining the amount of change in the coupling angle between the towing vehicle 11 and the towed vehicle 12 at the start of driving, calculates the current coupling angle between the towing vehicle 11 and the towed vehicle 12. The coupling angle calculation device 40 outputs information on the calculated coupling angle to a predetermined device, for example the automatic driving control device 112 or a display device visually recognized by the driver (S3).
[0062] The processing of steps S1 to S3 is repeatedly executed at predetermined time intervals until operation of the towing vehicle 10 is terminated ("NO" at S4). When the towing vehicle 10 temporarily stops while it is being operated, the coupling angle calculation device 40 calculates the coupling angle calculated immediately before it stopped as the coupling angle while stopped. By calculating the coupling angle in this manner, even if the measurement values of the angle sensors fluctuate due to fluctuations in the cable 15 when the towing vehicle 10 is stopped and the coupling angle does not fluctuate, this fluctuation in the measurement values is ignored, making it possible to avoid erroneous detection of a change in the coupling angle.
[0063] When the driving direction of the towing vehicle 10 is changed to the left or right while it is traveling, the connection angle between the towing vehicle 11 and the towed vehicle 12 changes, and in conjunction with this, the left-right orientation of each link member 21 in the link structure 20 also changes. When angle information detected by each angle sensor 30 after the orientation of each link member 21 has changed is transmitted to the connection angle calculation device 40, the connection angle calculation device 40 calculates the changed connection angle based on the acquired angle information and outputs it to the automatic driving control device 112 or a display device.
[0064] The automatic driving control device 112 can reflect the acquired coupling angle information in the driving content by the in-vehicle device 111, and for example, controls the driving speed to be reduced when the coupling angle becomes larger than a predetermined value. Also, when the driver recognizes based on the information displayed on the display device that the coupling angle has become larger than a predetermined value, he changes the driving content to reduce the driving speed. By changing the driving content based on the output information in this way, the towing vehicle 10 can be driven safely.
[0065] When the towing vehicle 10 stops traveling ("YES" in S4), the calculation and output process of the coupling angle also ends.
[0066] According to the above embodiment, the coupling angle of two vehicles constituting an articulated vehicle can be detected with high accuracy by simple processing.
[0067] The link structure 20 of the above-described embodiment may be configured so that it can be installed later on the towing vehicle 10. By configuring the link structure 20 so that it can be installed later on the towing vehicle 10, it can be easily attached to an existing towing vehicle that is not equipped with a coupling angle detection sensor, simply by providing equipment for installing the link structure 20 on the towing vehicle 11 side.
[0068] In addition, in the above-mentioned embodiment, the link structure 20 is described as being installed along the cable 15, but the installation position of the link structure 20 is not limited as long as both ends of the link structure 20 are fixed to the towing vehicle 11 and the towed vehicle 12 and the main body does not interfere with driving.
[0069] Furthermore, in the above embodiment, the case where the end of the link structure 20 is connected to the connector 14 of the towed vehicle 12 has been described, but the end may be connected to another predetermined position within the towed vehicle 12 as long as it does not interfere with traveling and does not change within the towed vehicle 12 while traveling. By connecting the end of the link structure 20 to a position within the towed vehicle 12 that does not change while traveling, the coupling angle between the towing vehicle 11 and the towed vehicle 12 can be detected with high accuracy.
[0070] In the above embodiment, the link structure 20 is configured as a serial link mechanism connected in series, but it may be configured as a parallel link mechanism in which a plurality of link structures are connected in parallel. In the case of a parallel link mechanism, the coupling angle between the towing vehicle 11 and the towed vehicle 12 can be obtained by detecting the positions of the link members using a displacement sensor according to the forward kinematic analysis method described in "Forward Kinematics Calculation Algorithm for Stewart Platform Type Parallel Link Manipulators by Kazuhiro Kosuge, Hiroyuki Kawamata, Toshio Fukuda, Toshiki Kozuka, and Tomoo Mizuno."
[0071] The use of a link structure for a parallel link mechanism enables high rigidity, high speed and precise operation.
[0072] Although several embodiments have been described, the embodiments can be modified or modified based on the above disclosure. All components of the above embodiments and all features described in the claims may be individually extracted and combined as long as they are not mutually inconsistent. [Explanation of symbols]
[0073] 1. Link angle calculation system 10 Towing vehicle 11 Towing vehicle 12 Towed vehicle 13 Connecting members 14 Connectors 15 Cable 16 Retrofit connector 20, 20A, 20B, 20C, 20D Link structure 21, 21a, 21b, 21c, 21d, 21e, 21f, 21g, 21h, 21i, 21j, 21k, 21m Link members 22, 22a, 22b, 22c, 22d, 22e, 22f, 22g, 22h, 22i, joint members 23 Telescopic mechanism 24a, 24b Internal cables 30, 30a, 30b, 30c, 30d, 30e, 30f Angle sensor 40 Connection angle calculation device 41 CPU 42 Output section 411 Sensor information acquisition unit 412 Connection angle calculation part
Claims
1. a link structure including a plurality of link members and a joint member that connects the plurality of link members to form a link mechanism, the link structure having both ends connected to a first vehicle and a second vehicle connected to the first vehicle, respectively; a link detection sensor that detects at least one of a direction and a position of the link member; a link angle calculation device that calculates a link angle between the first vehicle and the second vehicle based on information on the direction or position of the link member detected by the link detection sensor.
2. 2. The articulation angle calculation system for articulated vehicles according to claim 1, wherein the link structure is constituted by a serial link mechanism or a parallel link mechanism.
3. 2. The articulation angle calculation system for articulated vehicles according to claim 1, wherein the link members of the link structure are configured so that their direction or position can be changed by a rotational movement or a telescopic movement about an axis in a predetermined direction.
4. 2. The system for calculating a link angle of articulated vehicles according to claim 1, wherein the link detection sensor operates using power supplied from the first vehicle or the second vehicle connected thereto.
5. 2. The articulation angle calculation system for articulated vehicles according to claim 1, wherein the link structure is installed along a cable that communicates information between a predetermined position of the first vehicle and a predetermined position of the second vehicle, or is configured with the cable passing through an interior of the link structure.
6. 2. The articulation angle calculation system for articulated vehicles according to claim 1, wherein one end of the link structure is connected to a connector in the second vehicle to which a cable for communicating with the first vehicle is connected.
7. 2. The articulation angle calculation system for articulated vehicles according to claim 1, wherein the link detection sensor detects at least one of a direction and a position of the link member by using a signal transmitted from the first vehicle to the second vehicle.
8. a link mechanism including a plurality of link members and a joint member that connects the plurality of link members to form a link mechanism, both ends of which are communicatively connected to link detection sensors that detect at least one of the direction and the position of the link members within a link structure that is connected to a first vehicle and a second vehicle connected to the first vehicle, a link angle calculation device for articulated vehicles comprising: a link angle calculation unit that calculates a link angle between the first vehicle and the second vehicle based on information on a direction or position of the link member detected by the link detection sensor.
9. a link structure including a plurality of link members and a joint member that connects the plurality of link members to form a link mechanism, both ends of the link structure being connected to a first vehicle and a second vehicle connected to the first vehicle, the link angle calculation device being communicatively connected to a link detection sensor that detects at least one of a direction and a position of the link members; a link angle calculation method for articulated vehicles, the method comprising: calculating a link angle between the first vehicle and the second vehicle based on information on a direction or position of the link member detected by the link detection sensor;
Citation Information
Patent Citations
Trailer connecting angle detecting device
JP2002114176A
