Travel assistance device and travel assistance control method

The travel aid device addresses the limitations of existing systems by using a control unit to adjust driving force based on friction and speed, allowing connection to various equipment without a dedicated operation unit, enhancing usability and control for operators.

WO2024228372A1PCT designated stage expired Publication Date: 2024-11-07NSK LTD
View PDF 6 Cites 0 Cited by

Patent Information

Application Number
PCT/JP2024/016532
Authority / Receiving Office
WO · WO
Patent Type
Applications
Current Assignee / Owner
Priority Date
2023-05-01
Filing Date
2024-04-26
Publication Date
2024-11-07

AI Technical Summary

Technical Problem

Existing travel assistance devices require a dedicated operation unit and are not adaptable to various transportation devices or multiple operators, limiting their applicability and usability.

Method used

A travel aid device with a driving wheel, speed acquisition unit, connecting part, driving force acquisition part, and control unit that calculates friction force and adjusts driving force based on speed and load, allowing connection to and detachment from existing equipment without a dedicated operation unit, and providing intuitive operation and adaptive control for different weights and environments.

Benefits of technology

Reduces the external force required for operators to move transportation devices, enabling easy use in crowded spaces and precise control, with the ability to assist driving or braking, and adapt to different loads and conditions.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure JP2024016532_07112024_PF_FP_ABST
    Figure JP2024016532_07112024_PF_FP_ABST
Patent Text Reader

Abstract

This travel assistance device can be connected to and detached from an existing travel implement, and supports travel of the travel implement without the need for a dedicated operating unit. The travel assistance device comprises a driving wheel 20 supported on a device main body, a speed acquiring unit 20a for acquiring information relating to a speed and an angular velocity, a connection unit connected to a travel implement provided with a plurality of driven wheels to accept a load applied from the travel implement, a driving force acquiring unit 10b for acquiring a driving force ψR due to the driving wheel 20, and a control unit 22, wherein the control unit 22: calculates a frictional force ψf of a driven wheel 220 on the basis of the driving force ψR in a state in which an external force ψH is not being applied to the travel implement 200; if the speed of the device main body 10 is equal to or greater than a predetermined threshold, performs control such that the driving wheel 20 travels with a driving force that resists the frictional force ψf; and if the speed of the device main body 10 is less than the predetermined threshold, performs control such that the driving force of the driving wheel 20 is zero.
Need to check novelty before this filing date? Find Prior Art

Description

Driving assistance device and driving assistance control method

[0001] The present invention relates to a driving assistance device and a driving assistance control method.

[0002] There are known running assistance devices that assist the running of running equipment, such as a dolly with swivel wheels, a transport cart, a mobile bed, a stretcher, etc., which carries an object to be transported and is manually pushed by an operator to travel on a floor surface. The running assistance device reduces the force required by the operator to operate the running equipment by applying a driving force for running in accordance with the force applied by the operator.

[0003] For example, Patent Document 1 discloses a floor platform that moves an operating table in all directions in accordance with the operation of a dedicated manual operating element provided on the operating table. Patent Document 2 discloses a power-assisted transport device in which a handle and a drive unit operated by the handle can be attached to an existing stretcher. Patent Document 3 discloses a unit that is attached to the bottom of the stretcher and is operated by a control panel attached to the stretcher to assist the stretcher in traveling when the wheels touch the ground.

[0004] JP-T-2017-536150A JP-A-2006-001426 JP-A-2000-107230

[0005] However, the driving assistance devices disclosed in Patent Documents 1, 2, and 3 are operated by a dedicated operating unit, and therefore cannot be applied to a variety of transport devices or when multiple people are driving a transport device.

[0006] The present invention has been made in consideration of the above, and aims to provide a running assistance device and a running assistance control method that can be connected to and detached from existing running equipment and can assist the running of the running equipment without requiring a dedicated operating unit.

[0007] A running assistance device according to one aspect of the present invention comprises a drive wheel supported on a device main body to drive the device main body, a speed acquisition unit that acquires information on the speed and angular velocity of the device main body, a connection unit that connects to a running implement having a main body and a plurality of driven wheels supported on the main body and receives a load from the running implement, a drive force acquisition unit that acquires the drive force of the drive wheel, and a control unit, wherein the control unit calculates the frictional force of the driven wheel based on the drive force when no external force is applied to the running implement, and controls the drive wheel to run with a drive force that resists the frictional force when the speed of the device main body is equal to or greater than a predetermined threshold, and controls the drive force of the drive wheel to be zero when the speed of the device main body is less than the predetermined threshold.

[0008] This eliminates the need for a dedicated operating unit and reduces the load caused by frictional force applied to the traveling tool via the driven wheels, thereby reducing the external force applied by the operator to propel the traveling tool. The traveling assistance device is connectable to and detachable from existing traveling tools at the connection unit, making it applicable to a variety of traveling tools. Furthermore, since the frictional force applied to the traveling tool with the transport object loaded is calculated, traveling assistance control can be performed to apply a driving force corresponding to the frictional force, even when transport objects of different weights are loaded. Furthermore, conditions can be classified based on the speed information acquired by the speed acquisition unit, and the device can transition to the appropriate control, whether to provide or not provide traveling assistance.

[0009] In one aspect of the running assistance device of the present invention, the control unit calculates an estimated value of the external force acting on the running implement based on the driving force and the frictional force, and when the speed of the device body is equal to or greater than a predetermined threshold, calculates a driving force based on the external force to reduce the external force and controls the drive wheels to run with that driving force, and when the speed of the device body is less than the predetermined threshold, controls the driving force of the drive wheels to be zero.

[0010] This system assists the traveling tool in traveling in the direction in which the operator applies external force, reducing the burden on the operator, without requiring a dedicated operating unit. Even without a dedicated operating unit, the operator can grasp any part of the traveling tool with their hands and operate it directly, eliminating the need for special training to operate the traveling assist device, and enabling delicate movements of the traveling tool even in small spaces or crowded environments. Furthermore, since the system calculates the frictional force acting on the traveling tool with the object being transported loaded, the system estimates the external force applied by the operator operating the traveling tool from the frictional force and driving force, assuming the frictional force of the traveling tool including the object being transported, and controls the traveling tool to reduce this external force. Therefore, the system can provide traveling assistance control that corresponds to the weight of objects being transported, even when different weights are loaded.

[0011] In one aspect of the driving assistance device of the present invention, when the speed of the device main body is equal to or greater than a predetermined threshold, the control unit calculates a driving force that is proportional to and smaller than the external force, and controls the drive wheels to drive with that driving force.

[0012] According to this, as the external force applied by the operator increases, the driving force that assists the vehicle's running increases proportionally, allowing the operator to perform intuitive operation.

[0013] A driving assistance device according to one aspect of the present invention further includes an acceleration acquisition unit that acquires information about the acceleration of the device main body, and in the driving assistance device, when the speed of the device main body is equal to or greater than a predetermined threshold, the acceleration applied to the device main body acts in a direction opposite to the direction of driving, and the acceleration is equal to or greater than the predetermined threshold, the control unit uses a braking force calculated by multiplying the speed and the angular velocity by a predetermined viscous resistance coefficient as a driving force, and changes control so that the drive wheels drive using the driving force.

[0014] This suppresses vibrations when the speed and angular velocity are low, and increases braking force when the speed is high. Therefore, for example, when the traveling tool is about to come into contact with an obstacle, it can instantly slow down and stop while reducing the burden on the transported object.

[0015] In one aspect of the driving assistance device of the present invention, when the control unit is controlling the braking force as the driving force and the speed of the device main body is smaller than a predetermined threshold, the control unit changes the control so that the driving force of the drive wheels is zero.

[0016] According to this, by dividing the conditions based on the speed information acquired by the speed acquisition unit, it is possible to switch to and execute a suitable control, either control with brake assistance or control with neither driving assistance nor braking assistance. Also, by dividing the conditions based on the driving speed, it is possible to switch to and execute a suitable control, either control with driving assistance or control with no driving assistance.

[0017] In one aspect of the driving assistance device of the present invention, when the control unit is controlling the braking force as a driving force, if acceleration applied to the device main body acts in the driving direction and the acceleration is equal to or greater than a predetermined threshold, the control unit changes the control so that the drive wheels travel with a driving force that reduces the external force based on the external force.

[0018] This allows conditions to be classified based on the speed information acquired by the speed acquisition unit, and the control can be switched to the appropriate control, either to restart driving assistance or to continue braking, or the control can be continued.

[0019] In the running assist device according to one aspect of the present invention, the driven wheels of the running implement are swivel wheels.

[0020] When starting off, the load on the operator is least when the swivel is pushed horizontally, perpendicular to the axial direction of the swivel, and is greatest when pushed axially. The running assist device applies a driving force that resists the load caused by the frictional force of the running tool, thereby reducing the load on the operator when starting off and making it easy to start the running tool even when a load is applied in the axial direction of the swivel.

[0021] In one aspect of the running assistance device of the present invention, the control unit aligns the directions of the multiple driven wheels by running the running tool in one direction, then aligns the directions of the multiple driven wheels again by running the running tool in an intersecting direction perpendicular to the one direction, and further calculates the maximum static friction force as the friction force of the driven wheels based on the driving force when the driving wheel starts to run by applying a driving force in the intersecting direction to the driving wheel.

[0022] This prevents the friction force from being calculated as excessively large when the driven wheels turn or when a load is applied to the driven wheels in the axial direction when the vehicle starts moving. Also, by setting the value of the friction force used during driving assist control to the maximum static friction force, it is possible to reduce the large load when starting from a stationary state.

[0023] In one aspect of the running assistance device of the present invention, the control unit aligns the directions of the multiple driven wheels by running the running tool in one direction, then aligns the directions of the multiple driven wheels again by running the running tool in an intersecting direction perpendicular to the one direction, and further calculates the kinetic friction force as the friction force of the driven wheels based on the driving force when a driving force is applied to the drive wheels in the intersecting direction to run them at a constant speed.

[0024] This prevents the friction force from being overestimated when a driven wheel that was facing the opposite direction before the vehicle started to move turns while the vehicle is moving, causing a load to be applied to the driven wheel in the axial direction. Also, by using the kinetic friction force as the friction force value used in the drive assist control, it is possible to reduce the load caused by the friction force during driving by an amount substantially equivalent to that of the load applied during driving.

[0025] In a driving assistance device according to one aspect of the present invention, the driving force acquisition unit includes a load sensor that detects the load applied to the connection portion, and the load detected by the load sensor is regarded as the driving force of the driving assistance device.

[0026] In this way, when the running aid device transports the running implement, the load applied to the connection part is the force with which the running aid device pushes the running implement, and can therefore be regarded as the driving force of the running aid device. Therefore, a load sensor for detecting whether the connection between the running aid device and the running implement is normal or not can also be used as the driving force acquisition means.

[0027] In one aspect of the driving assistance device of the present invention, the connection portion includes a base portion that is square in plan view, and the load sensor includes a plurality of load sensors attached to a sensor mounting member having a groove portion that accommodates the base portion of the connection portion, and the plurality of load sensors include a first sensor group that is arranged on either side of the base in a first direction of a plane that intersects the axial direction and that contacts the base to measure a first measurement value corresponding to a displacement of the base, a second sensor group that is arranged on either side of the base in a second direction of the plane that intersects the first direction and that contacts the base to measure a second measurement value corresponding to a displacement of the base, and a third sensor group that is in contact with the base to measure a third measurement value corresponding to a displacement of the base in a third direction along the axial direction.

[0028] The connection part, which receives the load from the running tool, is supported on its four sides and bottom via multiple sensors attached to the sensor mounting member, and the multiple load sensors measure first, second, and third measurement values ​​corresponding to the displacement of the connection part in a first direction, a second direction, and a third direction. This allows, for example, the control unit 22 to calculate the load on three axes based on the measurement values ​​measured by the load sensors. Therefore, the running assist device can measure the measurement values ​​used to separate and calculate the load applied from the running tool along three axes. Furthermore, the running assist device is not limited to a specific material for the sensor mounting member on which the load sensors are attached.

[0029] In one aspect of the driving assistance device of the present invention, the first sensor groups are provided in pairs on each of two side surfaces of the base that face the first direction, and each of the first sensor groups measures the first measurement values ​​to measure two of the first measurement values, and the second sensor groups are provided in pairs on each of two side surfaces of the base that face the second direction, and each of the second sensor groups measures the second measurement values ​​to measure two of the second measurement values.

[0030] When a moment is applied to the connection part in a rotational direction around the third direction, two of the four load sensors arranged on opposite sides of the base, which are diagonally positioned, are pressed. Therefore, by arranging two load sensors on each side of the base, for example, the control unit can calculate the moment around the third direction based on the measurement values ​​measured by the load sensors, the distance to the load sensors, and the rotation angle around the third direction. In other words, the running assistance device can measure each measurement value for separating and calculating the load applied from the running tool along four axes.

[0031] In one aspect of the driving assistance device of the present invention, the control unit calculates the three-axial load acting on the connection part based on the first measurement value, the second measurement value, and the third measurement value, calculates the moment acting on the connection part about the third direction based on the first measurement value, the second measurement value, the distance from a predetermined origin of the connection part to the contact point between the base and the sensor, and the rotation angle of the connection part about the third direction, and considers the load acting in the first direction and the second direction and the moment about the third direction of the calculated three-axial loads to be the driving force of the driving assistance device.

[0032] When the running assist device is connected to the running implement, a load from the running implement is applied to the connection portion, and the connection portion is displaced by the load from the running implement, and the running assist device measures first, second, and third measurement values ​​corresponding to the displacement of the connection portion. The running assist device is capable of calculating the load in three axes using a control unit based on each measurement value. Furthermore, when a moment is applied to the connection portion in a rotational direction around the third direction, two diagonally positioned load sensors out of four load sensors arranged on opposing sides of the base are pressed. Therefore, by arranging two load sensors on each side of the base, the running assist device can calculate the moment around the third direction using a control unit based on each measurement value, the distance to the load sensor, and the rotation angle around the third direction. This allows the running assist device to calculate the moment around the third direction in addition to the loads applied in the first, second, and third directions. The load applied in the first and second directions is considered to be a translational driving force, and the moment around the third direction is considered to be a rotational driving force, and based on this, an estimated value of the external force applied by the operator operating the running equipment can be calculated.

[0033] In one aspect of the driving assistance device of the present invention, the load sensor has an outer frame which is a square ring-shaped plate, a tongue which is a square plate connected to one side of the inner peripheral edge of the outer frame and provided on the inner peripheral side of the outer frame, and a protrusion which protrudes from one face of the tongue and contacts the base, and two sensors which support the same side of the base are attached to the sensor mounting member so that the positions of the protrusions in the third direction are offset from each other.

[0034] This allows the locations that support the side surfaces of the base to vary in the third direction, making it possible to suppress unintended rotation of the connection portion including the base relative to the sensor mounting member.

[0035] In one aspect of the running assistance device of the present invention, the connection portion comprises a load-receiving member including a base portion having a square shape in a plan view and a connection pin portion protruding from the upper surface of the base and extending in the axial direction, and an attachment member attached to the running tool and having a fitting hole into which the connection pin portion can be inserted.

[0036] The load-receiving member of the running assistance device has a connecting pin portion, and the mounting member attached to the running tool has a fitting hole into which the connecting pin portion can be inserted, so that the running assistance device can be easily connected to and disconnected from the running tool.

[0037] In one aspect of the driving assistance device of the present invention, the connection pin portion includes a first pillar portion at its upper end, the first pillar portion having a shape other than a perfect circle when viewed in the axial direction, the fitting hole is formed by a first hole portion, a second hole portion, and a third hole portion which are connected in sequence, the first hole portion has a tapered inner wall which gradually becomes smaller toward the second hole portion, the second hole portion has a tapered inner wall which gradually becomes smaller toward the third hole portion and has a taper ratio which is smaller than the taper ratio of the first hole portion, and the third hole portion is capable of fitting into the first pillar portion of the connection pin portion.

[0038] As a result, when positioning the connection portion of the driving assistance device between the load-receiving member and the mounting member, the first hole positions the load-receiving member in two axial directions on a plane intersecting the axial direction, the second hole positions the load-receiving member in a rotational direction around the axial direction, and the third hole positions the load-receiving member in one axial direction by fitting the load-receiving member in the axial direction. This allows for four-axis positioning using only a combination of a single set of fitting holes and connection pins. Furthermore, when the load-receiving member moves toward the second hole relative to the mounting member through the first hole, one of the angular portions on the upper edge of the first columnar portion contacts the inner wall of the first hole and is guided by the inner wall, thereby moving toward the radial center. Furthermore, when the load-receiving member moves toward the third hole relative to the mounting member through the second hole, the angular portions located at both ends of the major axis of the first columnar portion contact the inner wall of the second hole and are guided toward the angular portion of the second hole, thereby rotating about the axial center. In other words, the connection portion can be positioned sequentially in two axial directions on a plane intersecting the axial direction, in a rotational direction around the axial direction, and in one axial direction simply by inserting the connection pin portion into the fitting hole from a state in which the connection pin portion faces the fitting hole, thereby easily positioning the connection portion in four axes.

[0039] A running assistance device according to one aspect of the present invention comprises a sliding member that is movable in one direction relative to the device main body, a lifting mechanism that connects the device main body to the front load-receiving member and raises and lowers the load-receiving member relative to the device main body as the sliding member moves, and a linear actuator that moves the sliding member in the one direction relative to the device main body, wherein the load-receiving member rises from below the attachment member fixed to the underside of the main body, thereby being able to hold the running implement via the attachment member, and can be detached from the attachment member and the running implement by descending.

[0040] As a result, the traveling aid device slips under the running implement and the load-receiving member connects to the attachment member attached to the running implement from below, making it easy to turn right and left, rotate, and switch between forward and reverse, allowing for stable traveling. Furthermore, by lowering the load-receiving member when slipping under the running implement before connecting to it, the overall height of the traveling aid device can be reduced, making it compatible with low-floor running implements. Furthermore, by lowering the load-receiving member, the connection to the attachment member attached to the running implement can be easily released, so if multiple attachment members are attached to multiple running implements in advance, multiple running implements can be transported one after another.

[0041] A driving assistance control method according to one aspect of the present invention is a driving assistance control method for assisting driving of a driving assist device comprising: drive wheels supported on a device main body to drive the device main body; a speed acquisition unit that acquires information on the speed and angular velocity of the device main body; a connection unit that connects to a driving tool and receives a load from the driving tool, the driving tool comprising a main body and a plurality of driven wheels supported on the main body, and a driving force acquisition unit that acquires driving force from the drive wheels. The driving assistance control method includes: a calibration process that calculates a frictional force of the driven wheels based on the driving force when no external force is being applied to the driving tool; and a finite state machine control process, wherein the finite state machine control process includes drive control that controls the drive wheels to drive with a driving force that resists the frictional force, and stop control that controls the drive force of the drive wheels to zero, and when a first condition is satisfied in the drive control, the finite state machine control process transitions from the drive control to the stop control, and when a second condition is satisfied in the stop control, the finite state machine control process transitions from the drive control to the stop control.

[0042] This reduces the load caused by the frictional force applied to the traveling tool via the driven wheels, without requiring a dedicated operating unit, thereby reducing the external force applied by the operator to travel the traveling tool. Furthermore, the traveling assistance device is connectable to and detachable from existing traveling tools at the connection unit, making it applicable to a variety of traveling tools. Furthermore, since the frictional force applied to the traveling tool with the transport object loaded is calculated, traveling assistance control is possible to apply a driving force corresponding to the frictional force even when transport objects of different weights are loaded. Furthermore, based on the conditions, the device can switch to the appropriate control, whether to provide or not provide traveling assistance.

[0043] In a driving assistance control method according to one aspect of the present invention, the first condition includes the speed of the device main body being less than a predetermined threshold, and the second condition includes the speed of the device main body being equal to or greater than a predetermined threshold.

[0044] According to this, by classifying conditions based on the speed information acquired by the speed acquisition unit, it is possible to transition to and execute the appropriate control, whether to provide control to assist driving or not.

[0045] A driving assistance control method according to one aspect of the present invention further includes an estimation process for calculating an estimated value of an external force acting on the traveling implement based on the driving force and the frictional force, and repeatedly executes the estimation process and the finite state machine control process. In the driving control, a driving force that reduces the external force is calculated based on the external force, and the driving wheels are controlled to travel with the calculated driving force. In the stop control, the driving force of the driving wheels is controlled to be zero.

[0046] This system assists the traveling tool in traveling in the direction in which the operator applies external force, reducing the burden on the operator, without requiring a dedicated operating unit. Even without a dedicated operating unit, the operator can grasp any part of the traveling tool with their hands and operate it directly, eliminating the need for special training to operate the traveling assist device, and enabling delicate movements of the traveling tool even in small spaces or crowded environments. Furthermore, since the system calculates the frictional force acting on the traveling tool with the object being transported loaded, the system estimates the external force applied by the operator operating the traveling tool from the frictional force and driving force, assuming the frictional force of the traveling tool including the object being transported, and controls the traveling tool to reduce this external force. Therefore, the system can provide traveling assistance control that corresponds to the weight of objects being transported, even when different weights are loaded.

[0047] In a driving assistance control method according to one aspect of the present invention, the finite state machine control process further includes braking control that uses a braking force calculated by multiplying the speed and the angular velocity by a predetermined viscosity resistance coefficient as a driving force and controls the driving wheels to travel with the driving force, and in the finite state machine control process, if a third condition is satisfied in the driving control, the process transitions from the driving control to the braking control, if a fourth condition is satisfied in the braking control, the process transitions from the braking control to the driving control, and if a fifth condition is satisfied in the braking control, the process transitions from the braking control to the stop control.

[0048] This allows vibration to be suppressed when the traveling speed and angular velocity are low, and braking force to be increased when the traveling speed is high. Therefore, for example, when the traveling tool is about to come into contact with an obstacle, it is possible to instantly decelerate and stop the tool while reducing the burden on the transported object. Furthermore, based on the conditions, it is possible to switch to and execute the appropriate control, whether to provide travel assistance, not provide assistance, or apply braking.

[0049] In a driving assistance control method according to one aspect of the present invention, the driving assistance device further includes an acceleration acquisition unit that acquires information on the acceleration of the device main body, and the third condition includes the acceleration applied to the device main body acting in a direction opposite to the driving direction and being equal to or greater than a predetermined threshold, the fourth condition includes the acceleration applied to the device main body acting in the driving direction and being equal to or greater than a predetermined threshold, and the fifth condition includes the speed of the device main body being less than a predetermined threshold.

[0050] According to this, by classifying conditions based on the speed information acquired by the speed acquisition unit, it is possible to transition to a suitable control, such as control to assist driving again, control not to assist driving, or control to continue braking, or to continue executing the control.

[0051] According to the present invention, it is possible to provide a running assistance device and a running assistance control method that can be connected to and detached from existing running equipment and can assist the running of the running equipment without requiring a dedicated operating unit.

[0052] FIG. 1 is a perspective view showing a state of a travel assistance device according to an embodiment before it is connected to a travel tool. FIG. 2 is a perspective view showing an example of the configuration of the travel assistance device according to an embodiment. FIG. 3 is a plan view of the travel assistance device shown in FIG. 2. FIG. 4 is a perspective view showing an example of the configuration of a lifting mechanism of the travel assistance device shown in FIG. 2. FIG. 5 is a perspective view showing a raised state of the lifting mechanism of FIG. 4. FIG. 6 is a perspective view showing an example of the configuration of a sliding member in the state of FIG. 5. FIG. 7 is an exploded perspective view showing an example of the configuration of a connection module according to an embodiment. FIG. 8 is a perspective view showing an example of the configuration of a sensor mounting member of the connection module shown in FIG. 7. FIG. 9 is a perspective view showing a state in which a sensor is mounted on the connection module shown in FIG. 7. FIG. 10 is a perspective view showing an example of the configuration of a load receiving member of the connection module shown in FIG. 7. FIG. 11 is a cross-sectional view showing a state in which the load receiving member shown in FIG. 10 is mounted on the sensor mounting member and sensor shown in FIG. 9. FIG. 12 is a plan view showing an example of the configuration of a cover member of the connection module shown in FIG. 7. FIG. 13 is a perspective view showing an example of the configuration of an attachment member of the connection module shown in FIG. 7. FIG. 14 is a diagram showing an example of a circuit diagram of sensors arranged opposite each other in the X-axis direction or the Y-axis direction. FIG. 15 is a diagram showing an example of a circuit diagram of a sensor arranged with a protrusion facing upward in the Z-axis direction. FIG. 16 is a side view, partially in cross section, showing the state of the travel assist device shown in FIG. 2 before connection to the travel tool. FIG. 17 is a side view, partially in cross section, showing the state of the travel assist device shown in FIG. 2 after connection to the travel tool. FIG. 18 is a diagram showing an example of a dynamic model of the travel tool used in the travel assist control process according to the embodiment. FIG. 19 is a flowchart showing the flow of the travel assist control process by the travel assist device according to the embodiment. FIG. 20 is a flowchart showing an example of the flow of the calibration process shown in FIG. 19. FIG. 21 is a flowchart showing a detailed example of step S310 shown in FIG. 20. FIG. 22 is a schematic diagram showing the alignment operation of the driven wheels of the travel tool. FIG. 23 is a flowchart showing a detailed example of step S320 shown in FIG. 20. FIG. 24 is a control block diagram of the travel assist device in the estimation process and the FSM control process. FIG. 25 is a control block diagram of the FSM control process.

[0053] Modes (embodiments) for carrying out the present invention will be described in detail with reference to the drawings. The present invention is not limited to the contents described in the following embodiments. Furthermore, the components described below include those that can be easily imagined by a person skilled in the art and those that are substantially the same. Furthermore, the components described below can be combined as appropriate.

[0054] (Embodiment) [Configuration of Running Assistance Device 1] First, the configuration of the running assistance device 1 according to the embodiment will be described with reference to FIGS. 1 to 6. FIG. 1 is a perspective view showing a state before the running assistance device according to the embodiment is connected to a running tool. FIG. 2 is a perspective view showing an example configuration of the running assistance device 1 according to the embodiment. FIG. 3 is a plan view of the running assistance device 1 shown in FIG. 2. FIG. 4 is a perspective view showing an example configuration of the lifting mechanism 40 of the running assistance device 1 shown in FIG. 2. FIG. 5 is a perspective view showing a raised state of the lifting mechanism 40 in FIG. 4. FIG. 6 is a perspective view showing an example configuration of the sliding member 30 in the state shown in FIG. 5. Note that in these figures, components other than those according to the invention are omitted as appropriate. In the following description, the horizontal longitudinal direction of the running assistance device 1 (the left-right direction in FIG. 3) will be referred to as the "front-rear direction," and the short-side direction (the up-down direction in FIG. 3) will be referred to as the "width direction."

[0055] The running assistance device 1 is a device that slips under a running tool 200 (see FIGS. 16 and 17 ) and connects to the running tool 200 from below to assist the running of the running tool 200. As shown in FIG. 1 , the running tool 200 includes a main body 210 on which an object to be transported is placed, a plurality of driven wheels 220 (swivel wheels) that can maintain the main body 210 in a horizontal position and move it horizontally when an external force including a horizontal component is applied, a mounting member 150 (described below) fixed to the center of the main body 210, a guide member 230, a stopper 240, and a handle 250 used by an operator to operate the running tool 200. The running assistance device 1 has a gap that allows it to slip under the main body 210. The guide member 230 includes a first arm 231 and a second arm 232 arranged parallel to the first arm 231. The running tool 200 may be, for example, a dolly, a transport cart, a mobile bed, a stretcher, or the like. The second arm 232 does not intersect with the first arm 231 and extends in one direction outside the main body portion 210 .

[0056] The first arm 231 and the second arm 232 are installed facing each other across the attachment member 150, and the rear ends of the first arm 231 and the second arm 232 are fixed to the attachment member 150 at a position perpendicular to the traveling direction of the running tool 200. The tips of the first arm 231 and the second arm 232 extend outward in a bow shape. The distance between the first arm 231 and the second arm 232 is designed to be smallest at the connection position below the running tool 200.

[0057] Because the first arm 231 and the second arm 232 protrude beyond the attachment member 150, as will be explained later, when the connection module 100 slips under the running tool 200 before connecting to the running tool 200, a space is provided between the connection module 100 and the attachment member 150. The connection module 100 enters between the first arm 231 and the second arm 232, and the first arm 231 and the second arm 232 guide the relative position of the running assist device 1 with respect to the running tool 200 to the connection position below the running tool 200.

[0058] The stoppers 240 are installed on both ends of the mounting member 150, opposite the positions where the first arm 231 and the second arm 232 are installed. The distance between the stoppers 240 is narrower than the width of the connection module 100, so that when the connection module 100 is directly below the mounting member 150, the stoppers 240 abut against the connection module 100, stopping the running assist device 1 and enabling connection to the running tool 200. When the connection module 100 slips under the mounting member 150 before connecting to the running tool 200, if the relative position of the running assist device 1 to the running tool 200 is shifted from the connection position, the stoppers 240, located in the center of the underside of the device body 10 of the running tool 200, abut against the front side of the connection module 100 and stop the running assist device 1. This allows the stoppers 240 to prevent the connection module 100 from passing under the mounting member 150.

[0059] As shown in FIG. 2 , the driving assistance device 1 of the embodiment includes a device main body 10 , four drive wheels 20 , a sliding member 30 , a lifting mechanism 40 , a linear actuator 50 , and a connection module 100 .

[0060] The device main body 10 supports the main components of the driving assist device 1, such as the drive wheels 20, sliding members 30, lifting mechanism 40, and linear actuator 50, on a horizontally oriented, plate-like base 11. The base 11 is formed with drive wheel openings 11a for exposing a portion of each drive wheel 20 below the base 11. The base 11 also has four sets of eight drive wheel support parts 12 that support the rotation shafts of the drive wheels 20, actuator support parts 13 that fix fixing parts 51 (see FIG. 4 , etc.) of the linear actuators 50 to the base 11, and various support members for the other components provided on the base 11.

[0061] The device main body 10 also has a cover member 15 that covers the sides and above of the components provided on the base 11. The cover member 15 has a lifting mechanism opening 15a. The lifting mechanism opening 15a is provided in the center of an upper surface 15b of the cover member 15. A connection module 100, described below, appears and disappears from the lifting mechanism opening 15a as the cover member 15 is raised and lowered. In the driving assistance device 1 of this embodiment, the height from the contact surface of the drive wheels 20 with the running surface to the upper surface 15b of the cover member 15 is 125 mm. The device main body 10, together with the base 11 and the cover member 15, forms a housing having a substantially rectangular parallelepiped shape.

[0062] The device main body 10 is also equipped with an acceleration acquisition unit 10a (see FIG. 24) that acquires the acceleration a of the device main body 10. The acceleration acquisition unit 10a is attached to, for example, the base 11 or the cover member 15. The acceleration acquisition unit 10a includes, for example, an inertial measurement unit (IMU). The acceleration acquisition unit 10a may be provided with, for example, an acceleration sensor and a rotational angular acceleration sensor (gyro sensor). The acceleration acquisition unit 10a acquires, for example, the acceleration a in the X-axis direction with respect to the acquired acceleration a. x The acceleration acquiring unit 10a outputs the acquired information on the acceleration a to the control unit 22, which will be described later.

[0063] In the embodiment, a total of four drive wheels 20 are provided on the front, rear, left, and right sides of the device main body 10. In the embodiment, the drive wheels 20 are Mecanum wheels that are capable of omnidirectional movement, but may be, for example, omniwheels. Each drive wheel 20 is provided rotatably about a rotation axis by a drive wheel support unit 12 fixed to the base 11. In the embodiment, one set of drive wheel support units 12 includes two support members arranged opposite each other with one drive wheel 20 sandwiched therebetween. The support members support both ends of the rotation axis of one drive wheel 20.

[0064] The drive wheels 20 receive a rotational driving force from the rotary actuators 21. The rotary actuators 21 include four rotary actuators 21 that drive the respective drive wheels 20. The rotary actuators 21 include, for example, brush-less direct-current (BLDC) motors. In this embodiment, the rotary actuators 21 include position detectors such as rotary encoders and hall sensors for estimating speed by odometry. In this embodiment, the rotary actuators 21 are disposed adjacent to the drive wheels 20 in the space between the front and rear drive wheels 20 so that their output shafts are parallel to the rotation axes of the drive wheels 20, and transmit torque to the drive wheels 20 via pulleys, belts, etc.

[0065] The rotational actuator 21 is controlled by a motor driver 21a (see FIG. 24 ). The motor driver 21a is included in, for example, a control unit 22 that controls each component of the driving assistance device 1. The motor driver 21a acquires rotation speed information from the rotational actuator 21. In this embodiment, the motor driver 21a outputs the rotation speed information to a speed acquisition unit 20a (see FIG. 24 ). The speed acquisition unit 20a acquires converted values ​​of the speed v and angular velocity ω of the entire driving assistance device 1 based on the rotation speeds of the four drive wheels 20. In this embodiment, the speed acquisition unit 20a acquires rotation speed information from each motor driver 21a that controls each rotational actuator 21, and includes a calculation processing unit that calculates the speed v and angular velocity ω of the entire driving assistance device 1 based on the acquired rotation speeds. The speed acquisition unit 20a calculates the speed v in the X-axis direction from the acquired speed v.x and the velocity in the Y-axis direction v y The velocity acquisition unit 20a can acquire the acquired velocity v x , v y and angular velocity ω z The information is output to the control unit 22 described below.

[0066] The driving assistance device 1 also generates a driving force (driving force ψ in Equation (10) described later) for driving the driving assistance device 1. R In the embodiment, the driving force acquisition unit 10b includes a sensor 120 (described later) and a load calculation unit 22a that is part of a control unit 22 (described later).

[0067] The control unit 22 includes hardware resources such as an arithmetic processing unit having a microprocessor such as a CPU (Central Processing Unit), memory such as a ROM (Read Only Memory) or a RAM (Random Access Memory), a storage unit, and an input / output interface device. The functions of the control unit 22 are realized by the arithmetic processing unit executing a predetermined program stored in the storage unit.

[0068] The control unit 22 also drives a drive source of the linear actuator 50 (described later) by, for example, executing a predetermined program. The control unit 22 also includes a load calculation unit 22a. The load calculation unit 22a, for example, executes a predetermined program to calculate three-axial loads F applied to a load receiving member 130 (described later) based on measurements by a sensor 120 (described later). x , F y , F z and moment M around the Z axis z In the embodiment, the control unit 22 calculates the acceleration a in the X-axis direction of the entire driving assistance device 1 acquired by the acceleration acquisition unit 10a. x In this embodiment, the control unit 22 also acquires the overall speed v of the driving assistance device 1 calculated based on the number of rotations acquired by the speed acquisition unit 20 a from the rotation actuator 21. x , v y and angular velocity ω zfrom the speed acquisition unit 20a. The control unit 22 outputs control signals to each component element to execute various functions according to the calculation results of the calculation processing unit, and outputs the calculation results to the outside.

[0069] The control unit 22 also executes a driving assistance control process shown in Fig. 19 and other figures, which will be described later. The device main body 10 may also be provided with an alarm unit that notifies the operator of the traveling tool 200 and those around them of the start and end of a calibration process S300 (see Figs. 19 and 20), which will be described later. The alarm unit may include a speaker or a light-emitting device that outputs a predetermined voice, alarm sound, light, or the like, in accordance with a predetermined calculation result by the control unit 22.

[0070] In this embodiment, the control unit 22 is disposed at one end of the device body 10 in the front-rear direction, above a fixed portion 51 of a linear actuator 50 (described later). For example, four motor drivers 21a (see FIG. 24 ) are disposed. The control unit 22, including the rotational actuator 21 and the motor drivers 21a, is driven by power supplied from a battery 23. The battery 23 is disposed at the other end of the device body 10 in the front-rear direction. The device body 10 is also provided with an emergency stop button 24 and a relay switch 25. When the operator presses the emergency stop button 24, the relay switch 25 turns off the main power supply of the driving assistance device 1, and the power supply from the battery 23 is stopped.

[0071] The sliding member 30 is provided so as to be movable in the front-rear direction relative to the base 11 of the device body 10. For example, the sliding member 30 may be provided so as to be movable along a guide rail that is provided in a horizontal position and parallel to the front-rear direction. The sliding member 30 has a pair of guide shaft portions 31 and a fixed portion 32.

[0072] The guide shaft portion 31 is a shaft member extending in the width direction of the device body 10. The guide shaft portion 31 is provided concentrically and integrally with a sliding shaft member 44b that is inserted into a pair of guide holes 41b of the lifting mechanism 40 (described later), or is fixed to the sliding shaft member 44b, or is provided in common with the sliding shaft member 44b. The sliding member 30 is movable in the front-rear direction relative to the base 11 within a range in which the guide shaft portion 31 and the sliding shaft member 44b can move within the guide hole 41b.

[0073] A movable part 52 of a linear actuator 50 (described later) is fixed to the fixed part 32. The sliding member 30 moves in the front-rear direction relative to the base 11 together with the movable part 52 as the linear actuator 50 is driven to expand and contract.

[0074] In the embodiment, the sliding member 30 is formed in a U-shape in plan view, with the fixed portion 32 fixed to the linear actuator 50 being a recessed portion 33. That is, the end portion in the direction in which the linear actuator 50 contracts relative to the fixed portion 32 is bifurcated. The guide shaft portions 31 are provided at each of the bifurcated ends. The sliding member 30 is formed so that the recessed portion 33 is provided in the direction in which the linear actuator 50 extends relative to the guide shaft portions 31. That is, the sliding member 30 is formed so that the connection portion with the movable portion 52 of the linear actuator 50 is located in the direction in which the linear actuator 50 extends relative to the connection portion with the lifting mechanism 40.

[0075] In this embodiment, the lifting mechanism 40 includes a scissors link mechanism including an X-shaped link. The lifting mechanism 40 connects the base 11 of the device main body 10 to a connection module 100 (described later) and supports the connection module 100 so that it can move up and down while maintaining the horizontal orientation of the connection module 100. The lifting mechanism 40 raises and lowers the connection module 100 relative to the device main body 10 in accordance with the forward and backward movement of the sliding member 30. The lifting mechanism 40 in this embodiment includes a base fixing portion 41, a connection mechanism fixing portion 42, a first link arm 43, a second link arm 44, and a central shaft member 45.

[0076] The base fixing part 41 is fixed to the base 11 of the device main body 10. In this embodiment, the base fixing part 41 includes a pair of support frames with an L-shaped cross section extending in the front-to-rear direction. The L-shaped bottom part of the base fixing part 41 is fixed to the base 11. The base fixing part 41 has a shaft hole 41a and a guide hole 41b in a flange part bent upward from one end side in the width direction of the L-shaped bottom part.

[0077] The shaft hole 41a is a round hole provided at the end of the base fixing part 41 extending in the front-rear direction in the direction in which the linear actuator 50 extends. The shaft hole 41a is provided in a horizontal position and penetrates the device main body 10 in the width direction. A rotating shaft member 43a provided on the lower end side of the first link arm 43 is inserted into the shaft hole 41a.

[0078] The guide hole 41b is a long hole extending in the front-rear direction from the end of the base fixing part 41 on the side where the linear actuator 50 retracts to the center. The guide hole 41b is provided horizontally and penetrates the device main body 10 in the width direction. A sliding shaft member 44b provided on the lower end side of the second link arm 44 is inserted into the guide hole 41b.

[0079] The connection mechanism fixing part 42 is fixed to a sensor mounting member 110 located at the lower end of the connection module 100, which will be described later. In this embodiment, the connection mechanism fixing part 42 includes a pair of support frames with an inverted L-shaped cross section that extends in the front-to-rear direction. The top surface of the inverted L-shape of the connection mechanism fixing part 42 is fixed to the sensor mounting member 110. The connection mechanism fixing part 42 has a shaft hole 42a and a guide hole 42b in a flange portion that is bent downward from one end edge in the width direction of the top surface of the inverted L-shape.

[0080] The shaft hole 42a is a round hole provided at the end of the connection mechanism fixing part 42 extending in the front-rear direction in the direction in which the linear motion actuator 50 extends. The shaft hole 42a is provided in a horizontal position and penetrates the device main body 10 in the width direction. A rotating shaft member 44a provided on the upper end side of the second link arm 44 is inserted into the shaft hole 42a.

[0081] The guide hole 42b is a long hole extending in the front-rear direction from the end of the connection mechanism fixing part 42 on the side where the linear actuator 50 retracts to the center. The guide hole 42b is provided in a horizontal position and penetrates the device main body 10 in the width direction. A sliding shaft member 43b provided on the upper end side of the first link arm 43 is inserted into the guide hole 42b.

[0082] The first link arm 43 connects the base fixing part 41 and the connection mechanism fixing part 42. The first link arm 43 is supported by a rotating shaft member 43a provided at the lower end in the longitudinal direction so as to be rotatable relative to the base fixing part 41 about an axis parallel to the width direction of the apparatus main body 10. The rotating shaft member 43a is inserted into a shaft hole 41a provided in the base fixing part 41. The rotating shaft member 43a is, for example, a pin member.

[0083] The first link arm 43 is supported by a sliding shaft member 43b provided at the upper end in the longitudinal direction relative to the connection mechanism fixing part 42 so as to be slidable in the front-to-rear direction of the device body 10 and rotatable around an axis parallel to the width direction of the device body 10. The sliding shaft member 43b is inserted into a guide hole 42b provided in the connection mechanism fixing part 42. The sliding shaft member 43b is, for example, a pin member.

[0084] The second link arm 44 connects the base fixing part 41 and the connection mechanism fixing part 42. The second link arm 44 is supported rotatably around an axis parallel to the width direction of the device main body 10 relative to the connection mechanism fixing part 42 via a rotating shaft member 44a provided at the upper end part in the longitudinal direction. The rotating shaft member 44a is inserted into a shaft hole 42a provided in the connection mechanism fixing part 42. The rotating shaft member 44a is, for example, a pin member.

[0085] The second link arm 44 is supported via a sliding shaft member 44b provided at the lower end in the longitudinal direction relative to the base fixing part 41 so as to be slidable in the front-to-rear direction of the device body 10 and rotatable around an axis parallel to the width direction of the device body 10. The sliding shaft member 44b is inserted into a guide hole 42b provided in the base fixing part 41. The sliding shaft member 44b is fixed to the guide shaft portion 31 of the sliding member 30 so as to be concentric with the guide shaft portion 31. The sliding shaft member 44b is, for example, a bolt.

[0086] The central shaft member 45 rotatably connects the central portions in the longitudinal direction of the first link arm 43 and the second link arm 44. The central shaft member 45 is, for example, a pin member.

[0087] The linear motion actuator 50 is a uniaxial actuator that expands and contracts in the front-to-rear direction of the device body 10. The linear motion actuator 50 expands and contracts by the driving force of the driving source, for example, when a control device (control unit 22) mounted on the device body 10 drives the driving source. The linear motion actuator 50 includes a fixed part 51 and a movable part 52.

[0088] In this embodiment, the fixed part 51 is a cylindrical housing whose axis is horizontal and parallel to the front-to-rear direction of the device body 10. One longitudinal end of the fixed part 51 is open, and a part of the movable part 52 is housed inside. The other longitudinal end of the fixed part 51 is fixed to the actuator support part 13 provided on the base 11 of the device body 10.

[0089] In this embodiment, the movable part 52 is a shaft whose axis is horizontal and parallel to the front-rear direction of the device body 10. A part of one longitudinal end of the movable part 52 is housed inside the fixed part 51. The other longitudinal end of the movable part 52 is fixed to the fixed part 32 of the sliding member 30.

[0090] The movable part 52 is capable of linear movement in the front-to-rear direction relative to the fixed part 51 and the device body 10. The linear-movement actuator 50 expands and contracts, causing the movable part 52 to linearly move in the front-to-rear direction relative to the fixed part 51 and the device body 10. The linear-movement actuator 50 linearly moves the sliding member 30 in the front-to-rear direction due to the linear movement of the movable part 52 in the front-to-rear direction.

[0091] [Configuration of the connection module 100] Next, the configuration of the connection module 100 according to the embodiment will be described with reference to Figs. 7 to 13. Fig. 7 is an exploded perspective view showing an example configuration of the connection module 100 according to the embodiment. In the following description, a horizontal direction is referred to as the X-axis direction, a horizontal intersecting direction perpendicular to the X-axis direction is referred to as the Y-axis direction, and a vertical direction perpendicular to the X-axis and Y-axis directions is referred to as the Z-axis direction. Furthermore, the direction of rotation around the Z-axis is referred to as the θ rotation direction.

[0092] The connection module 100 measures the load applied to the connection module 100 separately in the X-axis direction, Y-axis direction, Z-axis direction, and around the Z-axis. The connection module 100 of the embodiment also measures the moment around the Z-axis. The connection module 100 of the embodiment also functions as a connection mechanism that connects the device main body 10 of the traveling assistance device 1 with the traveling tool 200 (see FIGS. 16 and 17 ).

[0093] In an embodiment, the connection module 100 includes a sensor mounting member 110, a plurality of sensors 120, a load receiving member 130, a cover member 140, a mounting member 150, a pressure sensor 160, and a buffer material 170. In the connection module 100, the sensor mounting member 110, the plurality of sensors 120, the load receiving member 130, the cover member 140, the pressure sensor 160, and the buffer material 170 are separable from the mounting member 150. The sensor mounting member 110, the plurality of sensors 120, the load receiving member 130, and the cover member 140 are raised and lowered by an elevating mechanism 40 as the sliding member 30 moves forward and backward.

[0094] FIG. 8 is a perspective view showing an example of the configuration of the sensor mounting member 110 of the connection module 100 shown in FIG. 7 . In this embodiment, the sensor mounting member 110 is formed in a substantially rectangular prism shape with rounded corners in a plan view. The sensor mounting member 110 is a base portion of the connection module 100 and is fixed to the connection mechanism fixing portion 42 of the lifting mechanism 40. For example, the sensor mounting member 110 is attached with its bottom and side surfaces supported by the connection mechanism fixing portion 42. The sensor mounting member 110 moves up and down relative to the device main body 10 via the lifting mechanism 40 as the sliding member 30 moves forward and backward. The sensor mounting member 110 is formed with a plurality of cover fixing screw holes 111, a pin leg accommodating groove 112, eight sensor mounting slits 113, two sensor mounting recesses 114, and a wiring hole 115.

[0095] The cover fixing screw holes 111 are holes through which screws are inserted to fix the cover member 140 shown in FIG. 7 and FIG. 12 described below to the upper surface 110a of the sensor mounting member 110. The cover fixing screw holes 111 are formed from the upper surface 110a of the sensor mounting member 110 downward in the Z-axis direction. In this embodiment, four cover fixing screw holes 111 are provided. The four cover fixing screw holes 111 are formed at positions near the four corners of the sensor mounting member 110 in a plan view.

[0096] The pin leg accommodating groove 112 is a groove for accommodating the leg 135 of the load receiving member 130, which will be described later. The pin leg accommodating groove 112 is recessed downward from the upper surface 110a of the sensor mounting member 110 and has a rectangular ring shape in plan view. In plan view, the portion of the sensor mounting member 110 that is inside the inner periphery of the pin leg accommodating groove 112 is formed lower than the height of the upper surface 110a of the sensor mounting member 110 in the Z-axis direction.

[0097] The eight sensor mounting slits 113 are holes through which sensors 120 (described below) are inserted for installation. Each sensor mounting slit 113 has an elongated opening on the upper surface 110a of the sensor mounting member 110, and is formed from the upper surface 110a side toward downward in the Z-axis direction. In plan view, the sensor mounting slit 113 is formed between the outer periphery of the sensor mounting member 110 and the outer periphery of the pin leg accommodating groove 112, with the longitudinal direction of the elongated opening following the outer periphery of the pin leg accommodating groove 112. In each sensor mounting slit 113, a sensor opening 113a is formed on the pin leg accommodating groove 112 side so that the detection portion of the sensor 120 is exposed and facing the pin leg accommodating groove 112 side.

[0098] The eight sensor mounting slits 113 are formed so that the sensors 120 mounted near the outer periphery of the pin leg accommodating groove 112 are evenly spaced. That is, the eight sensor mounting slits 113 are formed so that they are line-symmetric in the X-axis direction, line-symmetric in the Y-axis direction, and point-symmetric at 90° around the Z-axis with respect to the center of the sensor mounting member 110, and so that they have the same height in the Z-axis direction. Specifically, two sensor mounting slits 113 are formed near each of the four sides of the outer periphery of the pin leg accommodating groove 112.

[0099] The two sensor mounting recesses 114 are recesses in which sensors 120, described below, are mounted. Each sensor mounting recess 114 is formed as a recess downward from the upper surface 110b at a portion inside the inner periphery of the pin leg accommodating groove 112 of the sensor mounting member 110. Each sensor mounting recess 114 is formed with a claw portion 114a for fixing the sensor 120 to the sensor mounting recess 114 with the detection portion of the sensor 120 facing upward. The claw portion 114a is formed to protrude inward from the edge of the sensor mounting recess 114 in a plan view and cover part of the upper surface side of the sensor 120.

[0100] The two sensor mounting recesses 114 are formed so that the sensors 120 to be mounted are evenly spaced. That is, the two sensor mounting recesses 114 are formed so that they are line-symmetrical in the X-axis direction and the Y-axis direction with respect to the center of the sensor mounting member 110, and have the same height in the Z-axis direction. Specifically, the two sensor mounting recesses 114 are formed side by side in the Y-axis direction.

[0101] The wiring hole 115 is a groove and hole through which wiring passes that connects to the sensor 120. The wiring that connects to the sensor 120 attached to the sensor attachment slit 113 extends from the sensor attachment slit 113 through a groove formed along the inner wall on the outer periphery of the pin leg accommodating groove portion 112 to the bottom surface 112a of the pin leg accommodating groove portion 112.

[0102] Furthermore, the wiring connected to the sensor 120 attached to the sensor mounting recess 114 extends from the sensor mounting recess 114 to the bottom surface 112a of the pin leg accommodating groove 112 through a groove formed along the upper surface 110b of the portion inside the inner periphery of the pin leg accommodating groove 112 and the inner wall on the inner periphery of the pin leg accommodating groove 112. Each wiring is routed so as to crawl between the bottom surface 112a of the pin leg accommodating groove 112 and the lower surface 131b of the leg 135 of the load receiving member 130 (see FIG. 11 described below), and is connected to other elements outside the connection module 100 via holes formed in the bottom surface 112a of the pin leg accommodating groove 112.

[0103] 9 is a perspective view showing the state in which sensors 120 are attached to the connection module 100 shown in FIG. 7. In this embodiment, the multiple sensors 120 include strain gauge-type load cells that detect load. One sensor 120 (load cell) has two strain gauges. Each sensor 120 has an outer frame 120a and a tongue 120b (see FIG. 7).

[0104] The outer frame 120a is a rectangular ring-shaped plate. The tongue 120b is a rectangular plate provided on the inner periphery of the outer frame 120a. One side of the tongue 120b is connected to one side of the inner periphery of the outer frame 120a, and the tongue 120b is provided integrally with the outer frame 120a. One strain gauge is provided on each of both sides of the tongue 120b. Furthermore, a protrusion 120c that contacts the load-receiving member 130 (described below) is formed at the center of one side of the tongue 120b. When pressed via the protrusion 120c, the tongue 120b swings around the connection with the outer frame 120a. Based on the strain generated by this movement, the sensor 120 detects a load applied in a direction perpendicular to the surface.

[0105] The multiple sensors 120 include a first sensor group, a second sensor group, and a third sensor group. The first sensor group supports the base 131 of the load receiving member 130 by sandwiching it in one horizontal direction (e.g., the Y-axis direction). The second sensor group supports the base 131 of the load receiving member 130 by sandwiching it horizontally and in an intersecting direction (e.g., the X-axis direction) perpendicular to the one direction. The third sensor group supports the base 131 of the load receiving member 130 from below in a vertical direction (the Z-axis direction) perpendicular to the one direction and the intersecting direction.

[0106] In the embodiment, the first sensor group includes four load cells: a first positive sensor 121p, a second positive sensor 122p, and a first negative sensor 121n, a second negative sensor 122n. In the embodiment, the second sensor group includes four load cells: a third positive sensor 123p, a fourth positive sensor 124p, and a third negative sensor 123n, a fourth negative sensor 124n. In the embodiment, the third sensor group includes two load cells: a fifth sensor 125, and a sixth sensor 126. That is, the multiple sensors 120 in the embodiment include a total of ten load cells. In the following description, when there is no need to particularly distinguish between the individual sensors, they will be simply referred to as sensors 120.

[0107] The first positive sensor 121p, the first negative sensor 121n, the second positive sensor 122p, the second negative sensor 122n, the third positive sensor 123p, the third negative sensor 123n, the fourth positive sensor 124p, and the fourth negative sensor 124n are attached by standing with their protrusions 120c facing the sensor opening 113a and inserting them into the sensor attachment slits 113 of the sensor attachment member 110. The upper ends of the sensors 120 attached to the sensor attachment slits 113 protrude above the upper surface 110a of the sensor attachment member 110. The outer frames 120a of the eight sensors 120 attached to the sensor attachment slits 113 are supported by the sensor attachment member 110 in positions where the protrusions 120c protrude from the sensor opening 113a toward the pin leg accommodating groove 112.

[0108] The first positive sensor 121p and the first negative sensor 121n are attached to the sensor mounting slits 113 at positions facing each other in the Y-axis direction relative to the center of the sensor mounting member 110. The second positive sensor 122p and the second negative sensor 122n are attached to the sensor mounting slits 113 at positions facing each other in the Y-axis direction relative to the center of the sensor mounting member 110. The first positive sensor 121p and the second positive sensor 122p are attached to the sensor mounting slits 113 at positions adjacent to each other in the X-axis direction. The first negative sensor 121n and the second negative sensor 122n are attached to the sensor mounting slits 113 at positions adjacent to each other in the X-axis direction.

[0109] The third positive sensor 123p and the third negative sensor 123n are attached to the sensor mounting slits 113 at positions facing each other in the X-axis direction relative to the center of the sensor mounting member 110. The fourth positive sensor 124p and the fourth negative sensor 124n are attached to the sensor mounting slits 113 at positions facing each other in the X-axis direction relative to the center of the sensor mounting member 110. The third positive sensor 123p and the fourth positive sensor 124p are attached to the sensor mounting slits 113 at positions adjacent to each other in the Y-axis direction. The third negative sensor 123n and the fourth negative sensor 124n are attached to the sensor mounting slits 113 at positions adjacent to each other in the Y-axis direction.

[0110] The eight sensors 120 attached to the sensor attachment slits 113 are attached upside down relative to adjacent sensors 120 (see FIG. 7 ). Specifically, the first positive sensor 121p, the second negative sensor 122n, the third negative sensor 123n, and the fourth positive sensor 124p are attached so that the connecting portion between the outer frame 120a and the tongue 120b is positioned upward. The first negative sensor 121n, the second positive sensor 122p, the third positive sensor 123p, and the fourth negative sensor 124n are attached so that the connecting portion between the outer frame 120a and the tongue 120b is positioned downward. As a result, the sensors 120 are arranged with the protrusions 120c of adjacent sensors 120 misaligned in the Z-axis direction.

[0111] The fifth sensor 125 and the sixth sensor 126 are laid down so that the protrusions 120c face upward, and are fitted into the sensor mounting recess 114. The two sensors 120 attached to the sensor mounting recess 114 are supported by the outer frame 120a on the sensor mounting member 110 with the protrusions 120c projecting upward from the upper surface 110b of the portion inside the inner periphery of the pin leg accommodating groove 112.

[0112] The two sensors 120 attached to the sensor attachment recess 114 are attached so that the positions of the connecting portion between the outer frame 120a and the tongue 120b are opposite in the Y-axis direction. Specifically, the fifth sensor 125 is attached so that the connecting portion between the outer frame 120a and the tongue 120b is located in the negative direction of the Y-axis. The sixth sensor 126 is attached so that the connecting portion between the outer frame 120a and the tongue 120b is located in the positive direction of the Y-axis.

[0113] Figure 10 is a perspective view showing an example configuration of the load receiving member 130 of the connection module 100 shown in Figure 7. Figure 11 is a cross-sectional view showing the load receiving member 130 shown in Figure 10 attached to the sensor mounting member 110 and sensor 120 shown in Figure 9. The load receiving member 130 is a member that receives a load applied to the traveling tool 200 and transmits the load to the sensor 120. The load receiving member 130 has a base 131 and a connection pin portion 132.

[0114] The base 131 is a portion that is supported by the sensor mounting member 110 via the sensor 120, and in this embodiment, is formed in a substantially quadrangular prism shape that is a square with rounded corners in a plan view. When the load receiving member 130 is supported by the sensor mounting member 110 via the sensor 120, the upper surface 131a of the base 131 is located below the upper surface 110a of the sensor mounting member 110. The base 131 includes recessed portions 133 and 134 and leg portions 135.

[0115] The recessed portion 133 is formed concavely upward from the lower surface 131b of the base 131, and is a square recessed portion with rounded corners when viewed from the bottom. The recessed portion 134 is formed concavely further upward from the top surface of the recessed portion 133, and is a square recessed portion with rounded corners when viewed from the bottom. The recessed portions 133 and 134 are formed so that their centers in a plan view are the center of the base 131. In other words, a two-stage quadrangular ring-shaped portion is formed on the lower surface 131b side of the base 131. The leg portion 135 is a quadrangular ring-shaped portion outside the outer periphery of the recessed portion 133.

[0116] The load receiving member 130 is provided so as not to come into direct contact with the sensor mounting member 110, and is supported by the sensor mounting member 110 via the plurality of sensors 120. That is, the load receiving member 130 is connected to the device main body 10 via the plurality of sensors 120, the sensor mounting member 110, and the lifting mechanism 40. At this time, the base 131 is supported with its legs 135 housed in the pin leg housing grooves 112 and its four side surfaces in contact with the sensors 120. Furthermore, the recessed portions 133 and 134 of the base 131 face the upper surface 110b of the portion inside the inner periphery of the pin leg housing groove 112.

[0117] The load receiving member 130 is supported from below by the top surface of the recessed portion 134 being supported by the protrusions 120c of the fifth sensor 125 and the sixth sensor 126. The recessed portions 133 and 134 do not contact the outer frames 120a of the fifth sensor 125 and the sixth sensor 126. In other words, the fifth sensor 125 and the sixth sensor 126 are disposed adjacent to each other and both receive a load from the bottom surface (top surface of the recessed portion 134) of the load receiving member 130, so the forces applied from the load receiving member 130 to the fifth sensor 125 and the sixth sensor 126 are in the same direction.

[0118] The load receiving member 130 is supported from the side by the outer peripheral side surfaces of the legs 135 being supported by the protrusions 120c of the first positive sensor 121p, the first negative sensor 121n, the second positive sensor 122p, the second negative sensor 122n, the third positive sensor 123p, the third negative sensor 123n, the fourth positive sensor 124p, and the fourth negative sensor 124n. The legs 135 do not come into contact with the inner wall and the bottom surface 112a of the pin leg accommodating groove 112.

[0119] As described above, the first positive sensor 121p and the first negative sensor 121n are disposed opposite each other in the Y-axis direction with the load receiving member 130 therebetween, so the forces applied to the first positive sensor 121p and the first negative sensor 121n from the load receiving member 130 are in opposite directions. Similarly, the second positive sensor 122p and the second negative sensor 122n are disposed opposite each other in the Y-axis direction with the load receiving member 130 therebetween, so the forces applied to the second positive sensor 122p and the second negative sensor 122n from the load receiving member 130 are in opposite directions.

[0120] Furthermore, since the third positive sensor 123p and the third negative sensor 123n are disposed opposite each other in the X-axis direction with the load receiving member 130 therebetween, the forces applied to the third positive sensor 123p and the third negative sensor 123n from the load receiving member 130 are in opposite directions. Similarly, the fourth positive sensor 124p and the fourth negative sensor 124n are disposed opposite each other in the X-axis direction with the load receiving member 130 therebetween, the forces applied to the fourth positive sensor 124p and the fourth negative sensor 124n from the load receiving member 130 are in opposite directions.

[0121] The connection pin portion 132 is formed to protrude from the center of the upper surface 131a side of the base portion 131 and extend in the axial direction (Z-axis direction). The connection pin portion 132 can be inserted from below into a fitting hole 154 of the mounting member 150 (described later). The connection pin portion 132 includes a first pillar portion 132a and a second pillar portion 132b.

[0122] The first pillar portion 132a is located at the upper end of the connection pin portion 132 and has a pillar shape with an axial direction parallel to the Z-axis direction and a constant XY cross-sectional shape. In the embodiment shown in FIG. 10 , the first pillar portion 132a has a rectangular pillar shape in which the cross-section cut along a plane perpendicular to the axial direction (hereinafter referred to as the XY cross-section) is a square shape with rounded corners. However, in this embodiment, any pillar shape other than a perfect circular pillar may be used, including a rectangular pillar other than a rectangular pillar or an elliptical pillar. Furthermore, the XY cross-sectional shape of the first pillar portion 132a may be a Reuleaux polygon, a lemon-shaped, or other shape with outwardly bulging edges. In other words, the first pillar portion 132a has a shape other than a perfect circle when viewed in the axial direction. It is preferable that the XY cross-sectional shape of the first pillar portion 132a be rotationally symmetric.

[0123] Furthermore, the angular portions 132c corresponding to the side edges of the first columnar portion 132a may be rounded or chamfered as in the embodiment. When the first columnar portion 132a is an elliptical cylinder, both end portions of the major axis are considered to be the angular portions 132c. Furthermore, in the embodiment, the top surface 132d of the first columnar portion 132a is formed as a flat surface parallel to the XY plane.

[0124] The second columnar section 132b is located below the first columnar section 132a, and has a columnar shape whose axial direction is parallel to the Z-axis direction and which flares out at the base with an exponential taper or a parabolic taper, etc. The side surface of the upper end of the second columnar section 132b is continuous with the side surface of the lower end of the first columnar section 132a, and the side surface of the lower end is continuous with the upper surface 131a of the base 131.

[0125] 12 is a plan view showing an example configuration of the cover member 140 of the connection module 100 shown in FIG. 7 . The cover member 140 is a rectangular ring-shaped protective member that covers the sensor 120 supported by the sensor mounting member 110. The cover member 140 has a lower surface fixed to the upper surface 110a of the sensor mounting member 110 and is arranged so as not to come into direct contact with the load receiving member 130. In other words, when the cover member 140 is fixed to the sensor mounting member 110, there is a gap between the lower surface of the cover member 140 and the upper surface 131a of the base 131 of the load receiving member 130, which is supported by the sensor mounting member 110 via the sensor 120. The cover member 140 has a fixing screw hole 141, a sensor hole 142, a pin opening 143, a pressure pin through hole 144, and a wiring hole 145.

[0126] The fixing screw holes 141 are holes through which screws are inserted to fix the cover member 140 to the upper surface 110a of the sensor mounting member 110 (see FIG. 8 , etc.). The fixing screw holes 141 are formed to penetrate in the Z-axis direction. The fixing screw holes 141 are provided at positions corresponding to the cover fixing screw holes 111 of the sensor mounting member 110 in plan view, and in this embodiment, a total of four fixing screw holes 141 are formed, one at each of the four corners in plan view.

[0127] The sensor holes 142 are holes into which the upper ends of the sensors 120 attached to the eight sensor mounting slits 113, which protrude above the upper surface 110a of the sensor mounting member 110, are inserted. The sensor holes 142 are formed from the underside of the cover member 140 upward in the Z-axis direction, and in this embodiment, penetrate the cover member 140 in the Z-axis direction. The same number of sensor holes 142 are provided at positions corresponding to the sensor mounting slits 113 in a plan view. In this embodiment, two sensor holes 142 are formed near each of the four sides, for a total of eight. When the cover member 140 is fixed to the upper surface 110a of the sensor mounting member 110, the upper ends of the sensors 120 attached to the eight sensor mounting slits 113 are located below the upper surface 110a of the sensor mounting member 110.

[0128] The pin opening 143 is an opening through which the connection pin portion 132 of the load receiving member 130 is inserted. In other words, the pin opening 143 indicates a portion inside the inner periphery of the square ring-shaped cover member 140. The pin opening 143 is formed so that its inner edge is spaced outward from the connection pin portion 132 in a plan view.

[0129] The pressure pin through holes 144 are through holes for inserting pressure pins 155 formed in the mounting member 150, which will be described later. The pressure pin through holes 144 are provided so as to penetrate in the Z-axis direction and have a diameter larger than the diameter of the pressure pins 155. The same number of pressure pin through holes 144 are provided at positions corresponding to the pressure pins 155 in a plan view, and in this embodiment, a total of two pressure pin through holes 144 are formed, one near each of the two diagonally opposite fixing screw holes 141.

[0130] The wiring hole 145 is a hole through which wiring passes that connects to the pressure sensor 160 described below. The wiring passes through the wiring hole 145 and, for example, through the wiring hole 115 of the sensor mounting member 110, and is connected to another element outside the connection module 100.

[0131] 13 is a perspective view showing an example configuration of the attachment member 150 of the connection module 100 shown in FIG. 7. The attachment member 150 is a member that is attached to the main body 210 of the running tool 200 (see FIGS. 16 and 17). The attachment member 150 is connectable to and separable from the load receiving member 130. By connecting the attachment member 150 to the load receiving member 130, the running assistance device 1 is connected to the running tool 200. The attachment member 150 has a base 151, a hole forming portion 152, a plurality of fixing holes 153 (four in this embodiment), a fitting hole 154, and a pressing pin 155.

[0132] The base 151 is attached to the main body 210 of the running tool 200 (see FIGS. 16 and 17), and in this embodiment, is formed as a thick plate with a regular square ring shape with rounded corners in a plan view. The upper surface 151a (see FIG. 7) of the base 151 faces the lower surface of the main body 210 of the running tool 200.

[0133] The hole forming portion 152 is formed in a convex shape downward from the lower surface 151b side of the base 151 in a plan view, and has a square convex shape with rounded corners in a plan view. The hole forming portion 152 is formed so that its center in a plan view is the center of the base 151. In other words, the base 151 has a square ring-shaped lower surface 151b outside the outer periphery of the hole forming portion 152. The mounting member 150 is formed so that the thickness in the Z-axis direction of the hole forming portion 152 part is greater than the thickness of the square ring-shaped part outside the outer periphery of the hole forming portion 152.

[0134] The fixing holes 153 are holes through which screws are inserted to fix the mounting member 150 to the underside of the main body 210 of the running tool 200 (see FIGS. 16 and 17 ). The fixing holes 153 are formed by penetrating the base 151 of the mounting member 150 in the Z-axis direction and include, for example, female threads on their inner circumferential surfaces. In this embodiment, four fixing holes 153 are provided. The four fixing holes 153 are formed in positions near the four corners of the mounting member 150 in a plan view. For example, with the upper surface 151 a of the base 151 aligned with the underside of the main body 210 of the running tool 200, the upper surface 151 a of the mounting member 150 is fixed to the underside of the main body 210 of the running tool 200 by threading a screw or the like into the fixing holes 153 from below.

[0135] The fitting hole 154 is a hole that penetrates the hole forming portion 152 of the mounting member 150 in the Z-axis direction, and the connection pin portion 132 of the load receiving member 130 can be inserted from below. The fitting hole 154 is formed in the center of the mounting member 150 in a plan view. The fitting hole 154 has a first hole portion 154a, a second hole portion 154b, and a third hole portion 154c that communicate in that order.

[0136] In the embodiment, the first hole 154a is located lower than the second hole 154b and the third hole 154c. The first hole 154a is a hole that opens to the underside of the mounting member 150 and has an axial direction parallel to the Z-axis direction. The first hole 154a has a tapered inner wall that gradually becomes smaller toward the second hole 154b. In the embodiment, the first hole 154a has an XY cross-sectional shape that is square with rounded corners. It is preferable that the XY cross-sectional shape of the first hole 154a is rotationally symmetric.

[0137] The second hole 154b is located between the first hole 154a and the third hole 154c. The second hole 154b is a hole that communicates with the upper part of the first hole 154a and has an axial direction parallel to the Z-axis direction. The second hole 154b gradually becomes smaller toward the third hole 154c and has a tapered inner wall with a taper ratio smaller than that of the first hole 154a. In this embodiment, the second hole 154b has an XY cross-sectional shape that is a square with rounded corners. It is preferable that the XY cross-sectional shape of the second hole 154b be rotationally symmetric.

[0138] In this embodiment, the third hole portion 154c is located above the first hole portion 154a and the second hole portion 154b. The third hole portion 154c is a hole that communicates with the upper part of the second hole portion 154b, has an axial direction parallel to the Z-axis direction, and has a constant shape in the XY cross section. The third hole portion 154c is a hole into which the first pillar portion 132a of the connection pin portion 132 of the load receiving member 130 can be fitted. When the third hole portion 154c is fitted into the first pillar portion 132a, the angular portion 154d faces the angular portion 132c of the first pillar portion 132a.

[0139] The third hole 154c in the embodiment opens to the upper surface 151a side of the mounting member 150. The third hole 154c in the embodiment has an XY cross-sectional shape that is square with rounded corners, but may have any shape as long as it does not include concave corners or concave curved surfaces on the outer periphery and can restrict rotation of the first columnar portion 132a in the θ rotation direction when fitted. It is preferable that the XY cross-sectional shape of the third hole 154c is rotationally symmetric.

[0140] When the connection pin portion 132 of the load-receiving member 130 is inserted through the fitting hole 154 from below, the first pillar portion 132a is guided successively through the first hole portion 154a and the second hole portion 154b of the fitting hole 154, and is fitted into the third hole portion 154c. The fitting hole 154 is formed so that the relationship L = 1 / D holds, where L is the minor axis at the boundary surface between the first hole portion 154a and the second hole portion 154b, and D is the major axis at the top surface 132d of the first pillar portion 132a of the load-receiving member 130.

[0141] The first pillar portion 132a fits into the third hole portion 154c, thereby positioning the load receiving member 130 and the mounting member 150 in the XY plane and the θ rotation direction. Furthermore, the first pillar portion 132a fits into the third hole portion 154c, and the lower edge 152a of the hole forming portion 152 of the mounting member 150 comes into contact with and is supported by the upper surface 131a of the base 131 of the load receiving member 130, thereby positioning the load receiving member 130 and the mounting member 150 in the Z axis direction. In other words, the load receiving member 130 and the mounting member 150 can be positioned in four axes.

[0142] When the first pillar portion 132a is fitted into the third hole portion 154c, the outer peripheral edge of the lower end of the first hole portion 154a is located inward from the base 131 of the load receiving member 130 in a plan view. In the load receiving member 130 of this embodiment, when the first pillar portion 132a is fitted into the third hole portion 154c and the base 131 supports the mounting member 150 from below, the upper surface 132d of the first pillar portion 132a is maintained at the same height as the upper surface 151a of the mounting member 150 or at a position lower than the upper surface 151a.

[0143] In the embodiment, the second hole 154b has an XY cross-sectional shape that is a square with rounded corners, but is not limited to a square in the present embodiment. For example, if the XY cross-sectional shapes of the first columnar portion 132a and the third hole 154c are regular polygonal, the second hole 154b may have an XY cross-sectional shape that does not include concave corners or concave curved surfaces on the outer periphery and has an XY cross-sectional shape that is a regular polygon with the number of vertices equal to or less than the XY cross-sectional shapes of the first columnar portion 132a and the third hole 154c.

[0144] In the embodiment, the first hole 154a has a square shape in XY cross section with rounded corners, but is not limited to a square shape in the present embodiment. For example, if the XY cross section of the second hole 154b is a regular polygon, the first hole 154a may have an XY cross section that does not include concave corners or concave curved surfaces on the outer periphery and has an XY cross section that is a regular polygon or a circle with the number of vertices equal to or less than the number of vertices of the XY cross section of the second hole 154b.

[0145] The pressing pins 155 are protrusions that press the pressure sensor 160 via the cushioning material 170 described below. The pressing pins 155 are formed to protrude from the lower surface 151b side of the base 151 and extend in a direction parallel to the Z-axis direction. The pressing pins 155 have dome-shaped tips. In the embodiment, the pressing pins 155 include two pressing pins 155 that are arranged diagonally in a plan view. When the mounting member 150 is connected to the load receiving member 130, the pressing pins 155 are inserted through the pressing pin through holes 144 of the cover member 140 and press the pressure sensor 160 that is arranged below the pressing pin through holes 144 via the cushioning material 170.

[0146] The pressure sensor 160 has, for example, a functional unit including an electrode and protective films arranged to sandwich the functional unit. The pressure sensor 160 is a sensor capable of measuring the position and magnitude of external pressure applied to the functional unit. The pressure sensors 160 are arranged to correspond to the positions and number of the pressing pins 155 and the pressing pin through holes 144 of the cover member 140. In a plan view, the same number of pressure sensors 160 are arranged at positions corresponding to the pressing pins 155 and the pressing pin through holes 144 of the cover member 140. In the embodiment, a total of two pressure sensors 160 are formed, one on each of the lower end sides of two diagonally opposite pressing pin through holes 144. The pressure sensors 160 are arranged, for example, fixed to the underside of the cover member 140 so that the pressing pin through holes 144 coincide with the functional unit in a plan view.

[0147] The buffer material 170 is disposed on the upper surface side of the functional portion of each pressure sensor 160. When the connection pin portion 132 of the load receiving member 130 is inserted into the fitting hole 154 of the mounting member 150 and the first column portion 132a and the third hole portion 154c are fitted together, the pressing pin 155 is inserted into the pressing pin through hole 144. At this time, the pressure sensor 160 detects the pressing of the tip of the pressing pin 155 on the pressure sensor 160 via the buffer material 170. In other words, the pressure sensor 160 detects the connection state between the load receiving member 130 and the mounting member 150.

[0148] The running assistance device 1 may include multiple attachment members 150 connectable to the load receiving member 130. By attaching the attachment member 150 to each of multiple running implements 200, the running assistance device 1 can sequentially connect to each of the running implements 200 and assist in running. A single running assistance device 1 may include multiple load receiving members 130 and attachment members 150. For example, if the running implement 200 can be supported at multiple locations, such as by connecting to the running implement 200 at the four corners of the running assistance device 1 in a plan view, this can be used even if the running implement 200 is large or heavy.

[0149] [Four-Axis Load Measurement Using the Connection Module 100] In the connection module 100, the running tool 200 is connected to the running assistance device 1, and when a force from the carrier is applied to the running tool 200 or when the running assistance device 1 accelerates, a load is applied to the load receiving member 130 via the attachment member 150. When a load is applied to the load receiving member 130, the load receiving member 130 transmits the applied load to the sensor 120 supporting the base 131.

[0150] 7, 9, and 11 will be described below. Of the eight sensors 120 attached to the sensor attachment slits 113, two sensors 120 are used in each to form a Wheatstone bridge circuit, and differential output voltage values ​​for positive and negative strain are measured.

[0151] Specifically, the third positive sensor 123p and the third negative sensor 123n facing each other in the X-axis direction form a Wheatstone bridge circuit, and a differential output voltage value V S3± The fourth positive sensor 124p and the fourth negative sensor 124n, which face each other in the X-axis direction, form a Wheatstone bridge circuit, and measure a differential output voltage value V S4± Measure.

[0152] The first positive sensor 121p and the first negative sensor 121n, which face each other in the Y-axis direction, form a Wheatstone bridge circuit, and a differential output voltage value V S1±In addition, the second positive sensor 122p and the second negative sensor 122n, which face each other in the Y-axis direction, form a Wheatstone bridge circuit, and measure a differential output voltage value V S2± Measure.

[0153] Differential output voltage value V S1± , V S2± , V S3± , V S4± 14 is a diagram showing an example of a circuit diagram of sensors 120 (strain gauges) that measure strain. Fig. 14 is a diagram showing an example of a circuit diagram of sensors 120 that are arranged opposite each other in the X-axis direction or the Y-axis direction. In the following description, a circuit diagram of a first positive sensor 121p and a first negative sensor 121n will be used as an example, but the second positive sensor 122p and the second negative sensor 122n, the third positive sensor 123p and the third negative sensor 123n, and the fourth positive sensor 124p and the fourth negative sensor 124n also have similar circuit configurations.

[0154] In the circuit diagram shown in FIG. 14, strain gauges Gp are connected to the four sides of the bridge circuit. 1 , Gp 2 , Gn 1 , Gn 2 is connected. Strain gauge Gp 1 is provided on the surface of the first positive sensor 121p on the protruding portion 120c side, and is provided on one side of the bridge circuit. 2 is the strain gauge Gp of the first positive sensor 121p 1 In the bridge circuit, the strain gauge Gp 1 The strain gauge Gn is provided on one side adjacent to the side on which the strain gauge Gn is provided. 1 is provided on the surface of the first negative sensor 121n on the protruding portion 120c side, and in the bridge circuit, 1 The strain gauge Gn is provided on the opposite side of the side on which the strain gauge Gn is provided. 2 is the strain gauge Gn of the first negative sensor 121n 1 In the bridge circuit, the strain gauge Gp 2As described above, the forces applied to the first positive sensor 121p and the first negative sensor 121n from the load receiving member 130 are in opposite directions. 1 and strain gauge Gn 2 strain in the same direction, strain gauge Gp 3 and strain gauge Gn 1 is distorted in the opposite direction.

[0155] In the circuit diagram shown in FIG. 14, the applied voltage V IN By applying this, the output voltage V OUT If the gauge factor is K and the strain is ε, the output voltage V OUT is expressed by the following formula (1). OUT When the sensors 120 connected to the circuit are the first positive sensor 121p and the first negative sensor 121n, V S1± is.

[0156]

[0157] The two sensors 120 attached to the sensor attachment recess 114 each measure an output voltage value V 1 in response to strain in the positive direction. Specifically, the fifth sensor 125 and the sixth sensor 126 arranged in the Y-axis direction each measure an output voltage value V 1 in response to strain in the positive direction of the Z-axis. S5+ , V S6+ Measure.

[0158] Output voltage value V S5+ , V S6+ A circuit diagram of the sensor 120 (strain gauge) that measures the strain is described below. Fig. 15 is a diagram showing an example of a circuit diagram of the sensor 120 that is arranged with the protrusion 120c facing upward in the Z-axis direction. Note that in the following description, the circuit diagram of the fifth sensor 125 will be used as an example, but the sixth sensor 126 also has a similar circuit configuration.

[0159] In the circuit diagram shown in FIG. 15, strain gauges G are provided on each of the four adjacent sides of the bridge circuit. 1 , G 2 and fixed resistor R 1 , R 2 is connected. Strain gauge G 1is provided on the surface of the fifth sensor 125 on the protrusion 120c side, and is provided on one side of the bridge circuit. 2 is the strain gauge G of the fifth sensor 125 1 In the bridge circuit, strain gauge G 1 The fixed resistor R 1 is the strain gauge G in the bridge circuit. 1 The fixed resistor R 2 is the strain gauge G in the bridge circuit. 2 As described above, the force applied to the fifth sensor 125 and the sixth sensor 126 from the load receiving member 130 is in the same direction, so the strain gauge G of the fifth sensor 125 1 and the sixth sensor 126 strain gauge G 1 is strained in the same direction, and the strain gauge G of the fifth sensor 125 2 and the sixth sensor 126 strain gauge G 2 is distorted in the opposite direction.

[0160] In the circuit diagram shown in FIG. 15, the applied voltage V IN By applying this, the output voltage V OUT is output. Output voltage V OUT is expressed by the following formula (2). OUT When the sensor 120 connected to the circuit is the fifth sensor 125, V S5+ and when the sensor 120 connected to the circuit is the sixth sensor 126, V S6+ is.

[0161]

[0162] The measured values ​​thus obtained by the connection module 100 are output to, for example, the control unit 22 of the driving assistance device 1. The control unit 22 calculates the three-axial load and the moment around the Z axis applied to the load receiving member 130 based on the measured values. The output power value when 1 [N] is applied to the sensor 120 is expressed as V cal In this case, the load F applied in the X-axis direction x , the load F applied in the Y-axis direction y, and the load F applied in the Z-axis direction z are expressed by the following equations (3), (4), and (5).

[0163]

[0164]

[0165]

[0166] Furthermore, when the distance from the origin of the load receiving member 130 to the contact point with the protrusion 120c of the sensor 120 is L and the rotation angle of the load receiving member 130 around the Z axis is φ, the moment M around the Z axis is z is expressed by the following mathematical formula (6): The origin of the load receiving member 130 is located at the center of the load receiving member 130 in a plan view, and is set to be located on the upper surface 132d of the load receiving member 130 shown in Fig. 11, for example. The angle φ is calculated based on the difference in the strain amount in the Y-axis direction or the X-axis direction at two contact points between the load receiving member 130 and the protrusions 120c of two sensors 120 adjacent in the X-axis direction or the Y-axis direction.

[0167]

[0168] [Operation of connecting the running assistance device 1 to the running tool 200] Next, the operation of connecting the running assistance device 1 to the running tool 200 will be described with reference to Fig. 16 and Fig. 17. Fig. 16 is a side view, partially in cross section, showing the running assistance device 1 shown in Fig. 1 in a state before being connected to the running tool 200. Fig. 17 is a side view, partially in cross section, showing the running assistance device 1 shown in Fig. 2 in a state after being connected to the running tool 200.

[0169] When transporting the running tool 200 with the running assistance device 1 of this embodiment, the worker attaches the attachment member 150 to the running tool 200 in advance. The worker fixes the upper surface 151a of the base 151 of the attachment member 150 to the underside of the running tool 200, for example, with a screw (not shown). When the running assistance device 1 is transporting multiple running tools 200, the worker attaches the attachment members 150 to all of the running tools 200 in advance. The worker also drives the lifting mechanism 40 via the sliding member 30 with the linear actuator 50 to lower the sensor mounting member 110 and the load receiving member 130.

[0170] When connecting, first, the drive wheels 20 are driven to move the running assist device 1 so that it slides under the running tool 200 to which the mounting member 150 is attached, as shown in Fig. 16. Next, the connection pin 132 of the load-receiving member 130 is positioned directly below the fitting hole 154 of the mounting member 150 so as to face the mounting pin 132.

[0171] When the running assist device 1 is made to slip under the running implement 200, for example, the running assist device 1 may run automatically, or an operator may control the running of the running assist device 1 from a terminal device via wireless communication, or the operator may use their hands or feet to push the running assist device 1 under the running implement 200. Methods of automatic running include, for example, a method of being guided by a transmitter such as a beacon, a method of attaching a marker (identifier) ​​near the guide member 230 that serves as the entrance to the running assist device 1 and recognizing the marker with a camera mounted on the running assist device 1, a method of identifying the relative positional relationship with the running implement 200 with a 3D camera mounted on the running assist device 1, or a method that combines these methods appropriately.

[0172] Next, the linear actuator 50 is driven in the direction of extension. As the linear actuator 50 extends, the movable part 52 moves the sliding member 30 in the front-rear direction toward the rotating shaft member 43a of the lifting mechanism 40 (to the right in FIGS. 16 and 17 ). Then, as shown in FIG. 17 , the lifting mechanism 40 lifts the load receiving member 130 via the sensor mounting member 110 and the sensor 120. More specifically, the movable part 52 moves together with the sliding member 30, and the sliding shaft member 44b of the second link arm 44 moves toward the rotating shaft member 43a within the guide hole 41b of the base fixing part 41.

[0173] At the same time, the second link arm 44 rotates about the axis of the rotating shaft member 44a, and the first link arm 43 connected via the central shaft member 45 rotates about the axis of the rotating shaft member 43a, and the sliding shaft member 43b moves toward the rotating shaft member 44a within the guide hole 42b of the connection mechanism fixing part 42. As a result, the load receiving member 130 rises together with the connection mechanism fixing part 42, via the sensor mounting member 110 and the sensor 120.

[0174] The raised load-receiving member 130 approaches the mounting member 150 from below, and the connection pin portion 132 is inserted from below into the fitting hole 154 to fit in. As a result, the load-receiving member 130 limits the movement of the mounting member 150 in the horizontal direction and in the rotational direction about the vertical axis, and supports the running tool 200 from below, thereby connecting the running assist device 1 to the running tool 200 via the connection module 100.

[0175] When the load-receiving member 130 and the mounting member 150 are connected accurately, the pressure sensor 160 is pressed against the pressing pin 155 via the buffer material 170, thereby detecting the connection state. The running assistance device 1 is positioned relative to the running tool 200 in four axes: the horizontal direction (XY plane direction), the vertical direction (Z-axis direction), and the rotation direction around the vertical axis (θ rotation direction) by fitting the connection pin portion 132 into the fitting hole 154.

[0176] At this time, when the running assistance device 1 runs, the connection module 100 moves in the direction of travel. The running assistance device 1 pulls the running implement 200 in the running direction via the connection module 100. The running assistance device 1 also pulls the running implement 200 in the direction of right / left turns or turning movements via the connection module 100. Furthermore, when the running implement 200 is run by the operator, the running assistance device 1 is pulled in the direction of the force applied to the running implement 200 via the connection module 100. In other words, the running assistance device 1 and the running implement 200 follow each other in the connected state.

[0177] When the running assist device 1 is to be detached from the running implement 200, the linear actuator 50 is driven in a direction to contract. As the linear actuator 50 contracts, the movable part 52 moves the sliding member 30 in the front-rear direction toward the fixed part 51 (to the left in FIGS. 16 and 17 ). Then, the sliding shaft member 44b of the second link arm 44 moves toward the fixed part 51 within the guide hole 41b of the base fixed part 41 together with the sliding member 30.

[0178] At the same time, the second link arm 44 rotates about the axis of the rotating shaft member 44a, and the first link arm 43 connected via the central shaft member 45 rotates about the axis of the rotating shaft member 43a, and the sliding shaft member 43b moves toward the fixed portion 51 within the guide hole 42b of the connection mechanism fixed portion 42. As a result, the sensor mounting member 110 and the load receiving member 130 move down together with the connection mechanism fixed portion 42.

[0179] The load receiving member 130 that has been lowered moves downward, with the connecting pin portion 132 coming out of the fitting hole 154, and moves away below the mounting member 150. As a result, the running assistance device 1 is detached from the running implement 200.

[0180] [Running Assist Control Method] Next, a running assistance control method in which the running assistance device 1 according to the embodiment assists the running of the running tool 200 will be described. First, a dynamic model of the running tool 200 used in the running assistance control process will be described. FIG. 18 is a diagram showing an example of the dynamic model of the running tool 200 used in the running assistance control process according to the embodiment. The dynamic model shows the balance of horizontal forces when the running assistance device 1 is connected to the running tool 200. Note that in the following description, boldface characters used to indicate vectors and matrices will be omitted.

[0181] 18 , points A, B, C, and D indicate the driven wheels 220 of the running tool 200, point S indicates the center of gravity of the running tool 200, and point H indicates the position where an operator of the running tool 200 grasps the running tool 200 to push or pull it. In the dynamic model of the embodiment, the X axis is set to the front-to-rear direction of the running aid device 1 and the running tool 200 (forward is the positive direction) with point S as the origin, and the Y axis is set to the width direction of the running aid device 1 and the running tool 200 (to the right when looking forward) with point S as the origin.

[0182] In the running assistance device 1 of the embodiment, the center of the connection module 100 coincides with point S. More specifically, in the embodiment, when the running assistance device 1 is connected to the running tool 200, the coordinate systems of the mechanical model and the connection module 100 shown in Figures 7 to 13 are the same. Note that the coordinate system of the mechanical model is not limited to the example shown in Figure 18, and for example, a global coordinate system having an arbitrary origin may be set and converted using a known conversion method.

[0183] In the dynamic model, the mass of the traveling device 200 including the transport object is M, the moment of inertia is I, the traveling speed is v, the angular velocity is ω, and the friction force of the driven wheel 220 is f A , f B , f C , f D and the translational driving force by the driving assistance device 1 is F R , turning drive force τ R and the translational external force applied by the operator to the running implement 200 is F H , the external rotation force τ H Then, the following equations (7) and (8) hold.

[0184]

[0185]

[0186] Furthermore, based on the equations (7) and (8), the term relating to the friction of the driven wheel 220 is expressed as the matrix ψ f and the term relating to the driving force by the driving assist device 1 is expressed as a matrix ψ R and the term relating to the external force by the operator is expressed as the matrix ψ H and the term relating to the inertial system is expressed as a matrix ψ in equation (12), the relationship between them is shown by equation (13).

[0187]

[0188]

[0189]

[0190]

[0191]

[0192] Next, the overall flow of the driving assistance control process will be described. Fig. 19 is a flowchart showing the flow of the driving assistance control process by the driving assistance device 1 according to the embodiment. The driving assistance control process shown in Fig. 19 is executed on the premise of the dynamic model shown in Fig. 18. It is assumed that the driving assistance device 1 is connected to the driving implement 200 by the operation described above.

[0193] The process shown in Fig. 19 is executed by the control unit 22 of the running assistance device 1 based on predetermined control programs and data. The control unit 22 starts the process of the flowchart shown in Fig. 19 when, for example, the pressure sensor 160 of the running assistance device 1 detects connection between the load receiving member 130 and the attachment member 150 attached to the running tool 200, or when a predetermined operation for starting running assistance operation is received. As shown in Fig. 19 , the running assistance control method of the embodiment includes a calibration process S300, an estimation process S400, and a finite state machine (FSM) control process (hereinafter referred to as the FSM control process S500).

[0194] In the calibration process S300, the friction force ψ of the driven wheel 220 of the traveling tool 200 is calculated. f (f A , f B , f C , f D ) is calculated. In the embodiment, the maximum static friction force when the running assist device 1 and the running tool 200 start moving from a stationary state is calculated. Here, the calibration process S300 will be described in more detail. FIG. 20 is a flowchart showing an example of the flow of the calibration process S300 shown in FIG. 19. As shown in FIG. 20, the calibration process S300 of the embodiment includes processing from step S301 to step S330. When the control unit 22 transitions to the calibration process S300 in the processing of the flowchart shown in FIG. 19, it executes processing in order from step S301 shown in FIG. 20.

[0195] In step S301, the control unit 22 starts detecting the speed of the driving assistance device 1. That is, the control unit 22 acquires the speed v and angular velocity ω of the driving assistance device 1 from the speed acquisition unit 20a (see FIG. 24) at predetermined intervals. More specifically, the speed acquisition unit 20a acquires the speed v in the X-axis direction based on the rotation speed of the rotation actuator 21. x、 Velocity in the Y-axis direction v y、 and angular velocity ω around the Z axis z is calculated at predetermined intervals, and the calculated velocity v x , v y and angular velocity ω z The control unit 22 outputs the information of the speed v of the device main body 10 calculated based on the number of rotations of the rotary actuator 21. x , v y and angular velocity ω z The control unit 22 then proceeds to step S302.

[0196] In step S302, the control unit 22 notifies the start of the calibration process S300. Specifically, the control unit 22 controls, for example, a notification unit including a speaker provided in the device main body 10 to output a predetermined sound for notifying those around the device that the calibration process S300 has started. In the calibration process S300, the external force ψ H (Translational external force F H and rotational external force τ H ) is zero. f (f A , f B , f C , f D ) is calculated. Therefore, in step S302, the control unit 22 notifies the operator and those around them of the start of the calibration process S300 to urge them to move away from and not touch the traveling tool 200. The control unit 22 proceeds to step S303.

[0197] In step S303, the control unit 22 determines whether the speed of the driving assistance device 1 is zero. After speed detection is started in step S301, the control unit 22 receives the speed v of the driving assistance device 1 from the speed acquisition unit 20a at predetermined intervals. x , v yand angular velocity ω z In step S303, the acquired speed v x , v y and angular velocity ω z When the running assist device 1 and the running implement 200 connected thereto are stopped, the control unit 22 determines whether the speed v x , v y and angular velocity ω z are both zero. x , v y and angular velocity ω z If it is determined that both are zero (step S303; Yes), the process proceeds to step S310.

[0198] The running assist device 1 and the running implement 200 connected thereto are subjected to a friction force ψ of the driven wheel 220. f If you are moving against the velocity v x , v y and angular velocity ω z At least one of the external forces ψ is not zero. H When the control unit 22 determines that the speed is not equal to 0 (step S303; No), the control unit 22 returns to step S302. Since the calibration process S300 must be started when the driving assistance device 1 is stopped, steps S302 to S303 are repeatedly executed until a Yes determination is made in step S303.

[0199] In step S310, the control unit 22 causes the running assist device 1 to run so as to align the driven wheels 220 of the running tool 200 connected to the running assist device 1. Aligning the driven wheels 220 means aligning the orientation of all (four in this embodiment) of the driven wheels 220 of the running tool 200. The orientation of the driven wheels 220 refers to the direction along which the driven wheels 220 can travel. When the driven wheels 220 rotate around the vertical axis (the swivel portion of the swivel wheel), the orientation of the driven wheels 220 also changes. Step S310 will be described in detail later. After completing step S310, the control unit 22 proceeds to step S320.

[0200] In step S320, the control unit 22 calculates the driving force ψ of the driving assist device 1. R Based on this, the friction force ψ of the driven wheel 220 of the running implement 200 f In step S320, the friction force ψ f The method for obtaining the value will be described in detail later. After completing step S320, the control unit 22 proceeds to step S330.

[0201] In step S330, the control unit 22 notifies the operator that the calibration process S300 has ended. Specifically, the control unit 22 controls, for example, a notification unit including a speaker provided in the device main body 10 to output a predetermined sound to notify those around the operator that the calibration process S300 has ended. As a result, in step S330, the operator is notified that preparations for running assistance to assist in the operation of the running tool 200 are complete, and is prompted to start operating the running tool 200. After executing step S330, the control unit 22 ends the processing of the flowchart shown in FIG. 20 .

[0202] Step S310 in the flowchart shown in FIG. 20 will now be described in detail. FIG. 21 is a flowchart showing a detailed example of step S310 shown in FIG. 20. FIG. 22 is a schematic diagram showing the alignment operation of the driven wheels 220 of the running tool 200. As shown in the lower left diagram of FIG. 22, it is assumed that the driven wheels 220 of the running tool 200 are oriented in different directions in the initial state. As shown in FIG. 21, step S310 includes the processes of steps S311 to S318. When the control unit 22 proceeds to step S310 in the processing of the flowchart shown in FIG. 20, the control unit 22 executes the processes in order from step S311 shown in FIG. 21.

[0203] In step S311, the control unit 22 applies brakes in the front-rear direction (X-axis direction) to the driving assistance device 1, and applies a driving force (translational driving force F Ry The driving force to the right increases the load F applied from the running implement 200 at the connection between the running assist device 1 and the running implement 200 when the running assist device 1 runs to the right without turning as a whole due to the rotation of each drive wheel 20.y The control unit 22 controls each rotation actuator 21 by the motor driver 21 a so that the rotation of each drive wheel 20 increases the driving force in the direction in which the driving assistance device 1 as a whole travels to the right by a predetermined amount.

[0204] Furthermore, in order to prevent the driving assistance device 1 from slipping in the front-rear direction (X-axis direction), the control unit 22 adjusts the front-rear speed v x The motor driver 21a controls each of the rotary actuators 21 so that the rotational speeds of the vehicle 1 become zero. Note that the control unit 22 maintains braking in the forward and backward directions from step S311 to step S314, which will be described later.

[0205] In step S312, the control unit 22 calculates the velocity v in the Y-axis direction acquired by the velocity acquisition unit 20a. y For a predetermined threshold v y1 Determine whether it is greater than (v y >v y1 ? ). The control unit 22 also calculates the velocity v in the X-axis direction acquired by the velocity acquisition unit 20a. x For a predetermined threshold v x0 Determine whether it is smaller than (v x <v x0 ? ). Threshold v y1 is a threshold value for determining the start state in the width direction (Y-axis direction) during the calibration process S300. y1 is a positive value close to zero, and is a fixed value that is set in advance to allow for errors due to vibrations, etc. y is the threshold value v y1 If the threshold value v is greater than the threshold value v, the driving assistance device 1 is considered to be moving in the positive direction of the Y axis. x0 is a threshold value for determining the stationary state in the front-back direction (X-axis direction) during the calibration process S300. x0 is a value close to zero, which is a fixed value set in advance to allow for errors due to vibrations, etc. x is the threshold value v x0 If it is smaller, the driving assistance device 1 is considered not to be moving in the X-axis direction.

[0206] 22 , when the running assist device 1 starts running to the right (positive direction of the Y axis), the driven wheels 220 of the running tool 200 rotate around the Z axis and become aligned in the Y axis direction. Alignment in the Y axis direction means that the axles of all the driven wheels 220 are parallel to the X axis direction and all the driven wheels 220 face the Y axis direction.

[0207] The control unit 22 y >v y1 and v x <v x0 If it is determined that at least one of the above conditions is not satisfied (step S312; No), the process returns to step S311, and the rightward driving force (translational driving force F Ry ) by a predetermined amount, and steps S311 to S312 are repeatedly executed until a Yes result is obtained in step S312.

[0208] As shown in the lower right diagram of Figure 22, when the driving assistance device 1 drives a certain distance to the right (positive Y-axis direction) with the brakes applied in the front-rear direction (X-axis direction), the driven wheels 220 are aligned in the Y-axis direction. In this case, the driven wheels 220 roll so as to drive in the Y-axis direction, and slippage in the X-axis direction disappears, so that v y >v y1 and v x <v x0 The control unit 22 calculates the velocity v in the Y-axis direction acquired by the velocity acquisition unit 20a. y is a predetermined threshold v y1 is larger than the velocity v in the X-axis direction acquired by the velocity acquisition unit 20a. x is a predetermined threshold v x0 If it is determined that it is smaller (step S312; Yes), the process proceeds to step S313.

[0209] In step S313, the driving assistance device 1 is caused to apply a brake in the width direction (Y-axis direction). That is, the speed v y The motor driver 21a controls each of the rotary actuators 21 so that the value of the rotational speed of the roller 21 becomes zero. Note that the control unit 22 maintains the brake in the width direction from step S313 to step S318 described later.

[0210] In step S314, the control unit 22 determines whether the speed of the driving assistance device 1 is zero. After speed detection is started in step S301, the control unit 22 receives the speed v of the driving assistance device 1 from the speed acquisition unit 20a at predetermined intervals. x , v y and angular velocity ω z In step S314, the acquired speed v x , v y and angular velocity ω z The control unit 22 determines whether all of the values ​​are zero or whether at least one of the values ​​is not zero.

[0211] If the braking in step S313 is weak and the driving assistance device 1 and the driving implement 200 connected thereto are not stopped, the speed v x , v y and angular velocity ω z At least one of the above is not 0. When the control unit 22 determines that the speed is not 0 (step S314; No), the process returns to step S313.

[0212] When the running assistance device 1 and the running implement 200 connected thereto are stopped, the speed v x , v y and angular velocity ω z are both zero. x , v y and angular velocity ω z If it is determined that both are zero (step S314; Yes), the process proceeds to step S315.

[0213] In step S315, the control unit 22 applies the brakes in the width direction (Y-axis direction) to the driving assistance device 1, and applies a driving force (translational driving force F Rx The forward driving force is generated by increasing the load F applied from the running implement 200 at the connection between the running assist device 1 and the running implement 200 when the running assist device 1 runs forward as a whole without turning due to the rotation of each drive wheel 20. xThe control unit 22 controls each rotation actuator 21 by the motor driver 21 a so that the rotation of each drive wheel 20 increases the driving force in the direction in which the driving assistance device 1 as a whole travels forward by a predetermined amount.

[0214] Furthermore, in order to prevent the driving assistance device 1 from slipping in the width direction, the control unit 22 adjusts the speed v x The motor driver 21a controls each of the rotary actuators 21 so that the value of the rotational speed of the roller 21 becomes zero. Note that the control unit 22 maintains the brake in the width direction from step S315 to step S318 described later.

[0215] In step S316, the control unit 22 calculates the velocity v in the X-axis direction acquired by the velocity acquisition unit 20a. x For a predetermined threshold v x1 Determine whether it is greater than (v x >v x1 ?) The control unit 22 also calculates the velocity v in the Y-axis direction acquired by the velocity acquisition unit 20a. y For a predetermined threshold v y0 Determine whether it is smaller than (v y <v y0 ? ). Threshold v x1 is a threshold value for determining the start state of the vehicle in the forward / backward direction (X-axis direction) during the calibration process S300. x1 is a positive value close to zero, and is a fixed value that is set in advance to allow for errors due to vibrations, etc. x is the threshold value v x1 If the threshold value v is greater than the threshold value v, the driving assistance device 1 is considered to be moving in the positive direction of the X axis. y0 is a threshold value for determining the stationary state in the width direction (Y-axis direction) during the calibration process S300. y0 is a value close to zero, which is a fixed value set in advance to allow for errors due to vibrations, etc. y is the threshold value v y0 If it is smaller, the driving assistance device 1 is considered not to be moving in the Y-axis direction.

[0216] 22 , when the running assist device 1 starts running forward (positive direction of the X-axis), the driven wheels 220 of the running tool 200 are aligned in the X-axis direction while rotating around the Z-axis direction. Alignment in the X-axis direction means that the axles of all the driven wheels 220 are parallel to the Y-axis direction and all the driven wheels 220 are facing in the X-axis direction.

[0217] The control unit 22 x >v x1 and v x <v x0 If it is determined that at least one of the above conditions is not satisfied (step S316; No), the process returns to step S315, and the forward driving force (translational driving force F Rx ) by a predetermined amount, and steps S315 to S316 are repeatedly executed until a Yes result is obtained in step S316.

[0218] As shown in the upper right diagram of Figure 22, when the driving assistance device 1 drives a certain distance forward (positive direction of the X axis) with the brakes applied in the width direction (Y axis direction), the driven wheels 220 are aligned in the X axis direction. In this case, the driven wheels 220 roll so as to drive in the X axis direction, and slippage in the Y axis direction disappears, so that v x >v x1 and v y <v y0 The control unit 22 calculates the velocity v in the X-axis direction acquired by the velocity acquisition unit 20a. x is a predetermined threshold v x1 is larger than the velocity v in the Y-axis direction acquired by the velocity acquisition unit 20a. y is a predetermined threshold v y0 If it is determined that it is smaller (step S316; Yes), the process proceeds to step S317.

[0219] In step S317, the driving assistance device 1 is caused to apply braking in the front-rear direction (X-axis direction). That is, the speed v x The motor driver 21a controls each of the rotary actuators 21 so that the value of the rotational angle .theta..times ...

[0220] In step S318, the control unit 22 determines whether the speed of the driving assistance device 1 is zero. After speed detection is started in step S301, the control unit 22 receives the speed v of the driving assistance device 1 from the speed acquisition unit 20a at predetermined intervals. x , v y and angular velocity ω z In step S318, the information of the acquired velocity v x , v y and angular velocity ω z The control unit 22 determines whether all of the values ​​are zero or whether at least one of the values ​​is not zero.

[0221] If the braking in step S317 is weak and the driving assistance device 1 and the driving implement 200 connected thereto are not stopped, the speed v x , v y and angular velocity ω z At least one of the above is not 0. If the control unit 22 determines that the speed is not 0 (step S318; No), the process returns to step S317.

[0222] When the running assistance device 1 and the running implement 200 connected thereto are stopped, the speed v x , v y and angular velocity ω z are both zero. x , v y and angular velocity ω z If it is determined that both are zero (step S318; Yes), the process of the flowchart shown in FIG. 21 ends, and the process proceeds to step S320 shown in FIG.

[0223] In steps S314 and S318, the speed v of the driving assistance device 1 is x , v y and angular velocity ω z is the above-mentioned threshold v x0 , v y0 and threshold ω z0 If the threshold value ω is smaller than ω<ω<ω, it may be determined that the driving assistance device 1 has stopped. In other words, an error due to vibration or the like when the driving assistance device 1 is stopped may be allowed. z0 is a threshold value for determining the stationary state in the rotation direction (direction around the Z axis).z0 is a value close to zero, and is a fixed value that is set in advance to allow for errors due to vibrations and the like.

[0224] Next, step S320 in the flowchart shown in Fig. 20 will be described in detail. Fig. 23 is a flowchart showing a detailed example of step S320 shown in Fig. 20. When the control unit 22 proceeds to step S320 in the processing of the flowchart shown in Fig. 20, it executes the processing in order from step S321 shown in Fig. 23.

[0225] In step S321, the control unit 22 starts detecting the load applied to the connection part of the running assistance device 1. In detecting the load, the control unit 22 detects the direction and magnitude of the load applied from the running tool 200 at the connection part between the running assistance device 1 and the running tool 200. That is, in this embodiment, the control unit 22 acquires, at predetermined intervals, a measured value of the voltage corresponding to the strain measured by the sensor 120 due to the load received by the load receiving member 130 from the attachment member 150 attached to the running tool 200. The control unit 22 then proceeds to step S322.

[0226] In step S322, the control unit 22 calculates the driving force (translational driving force F Rx The forward driving force is generated by increasing the load F applied from the running implement 200 at the connection between the running assist device 1 and the running implement 200 when the running assist device 1 moves forward as a whole due to the rotation of each drive wheel 20. x The control unit 22 controls each rotation actuator 21 by the motor driver 21a so that the rotation of each drive wheel 20 increases the driving force in the direction in which the driving assist device 1 as a whole travels forward by a predetermined amount. The control unit 22 proceeds to step S323.

[0227] In step S323, the control unit 22 calculates the speed v of the driving assistance device 1 in the X-axis direction. x is a predetermined threshold v x0 Determine whether it is greater than or equal to (v x ≧v x0 ?). Note that the threshold value v x0 is the threshold value v used in step S312 described above. x0Similarly to the velocity v, it is a value close to zero and is set in advance to allow for errors due to vibrations, etc. x is the threshold value v x0 If the translational driving force F is smaller than the predetermined value, the driving assistance device 1 is considered not to be moving in the X-axis direction. Rx It is determined whether the object has started to move in the X-axis direction by the threshold value v x0 is the threshold value v used in step S312 x0 After the speed detection is started in step S301 shown in FIG. 20 , the control unit 22 receives the speed v of the driving assistance device 1 from the speed acquisition unit 20 a at predetermined intervals. x In step S323, the acquired velocity v x is a predetermined threshold v x0 The control unit 22 determines whether or not this is the case.

[0228] In step S310 shown in FIG. 21, the driven wheels 220 are aligned in the X-axis direction, and in step S318, the speed v x , v y and angular velocity ω z is determined to be zero, only the driving force in the X-axis direction is applied in step S322, and therefore in step S323 it is assumed that the driving assistance device 1 only moves translationally in the X-axis direction.

[0229] The running assist device 1 and the running implement 200 connected thereto are configured to reduce the frictional force (static frictional force) f A , f B , f C , f D When the vehicle is kept stopped by x is zero. The control unit 22 x <v x0 If it is determined that the driving force is increased by a predetermined amount (step S323; No), the process returns to step S322, where the driving force is increased by a predetermined amount, and steps S322 to S323 are repeatedly executed until it is determined that the driving force is increased by a predetermined amount (step S323; No).

[0230] When the driving force applied to the running assist device 1 in step S322 causes the running implement 200 to move beyond the maximum static friction force of the driven wheel 220, the running implement 200 starts to move forward at a speed v x The control unit 22 calculates the velocity v x ≧v x0 If it is determined that the above is the case (step S323; Yes), the process proceeds to step S324.

[0231] In step S324, the control unit 22 acquires a measurement value of the load applied to the connection part. Specifically, the control unit 22 acquires a measurement value of the load applied to the connection part at the speed v x ≧v x0 Since the maximum static friction force occurs immediately before the robot starts moving, the control unit 22 periodically obtains the load measurement values ​​from the sensor 122 from step S322, and calculates the velocity v x ≧v x0 In step S324, it is preferable to obtain a load measurement value obtained immediately before determining that the load is not sufficient. The control unit 22 then proceeds to step S325.

[0232] In step S325, the control unit 22 calculates the friction force ψ of the driven wheel 220 based on the acquired measured value of the load. f (f A , f B , f C , f D ) is calculated. In the embodiment, the friction force ψ f is the maximum static friction force. First, the load calculation unit 22a of the control unit 22 calculates the load F that the running assistance device 1 receives at the connection part with the running tool 200 using the formula (3) based on the measurement value acquired from the sensor 120. x Calculate the load F x is the translational driving force F of the driving assistance device 1 R 21, the driven wheels 220 are aligned in the X-axis direction in step S310, and the speed v of the driving assistance device 1 is increased in step S318. xis zero (external force is zero), only the driving force in the X-axis direction is applied in step S322. Therefore, in step S324, it can be assumed that the load acting on the driving assistance device 1 is only the X-axis direction component.

[0233] Next, the control unit 22 calculates the translational driving force F Rx Based on this, the friction force ψ of the driven wheel 220 is calculated using Equation (7). f (f A , f B , f C , f D Here, as mentioned above, the equation (7) can be rearranged in only one axial direction, the X-axis direction. R (F Rx ) is the value at the moment when the running assistance device 1 and the running implement 200 start to move. Therefore, the speed v (v x ) is zero. In addition, in step S303 shown in FIG. 20, the speed v (v x ) is determined to be zero (external force is zero), so the translational external force F H is zero. Therefore, equation (7) becomes 0 = f A +f B +f C +f D +F R This can be summarized as follows.

[0234] In addition, at this time, since all of the driven wheels 220 are aligned in the X-axis direction, a friction force ψ acting on the driven wheels 220 in the X-axis direction is f (f A , f B , f C , f D ) is the maximum static friction force of the driven wheels 220. In addition, the friction force f A , f B , f C , f D are all the same (f A = f B = f C = f D ) to f A = f B = f C = f D =-F R / 4 is established. The control unit 22 proceeds to step S326.

[0235] In step S326, the control unit 22 applies the brakes to the driving assistance device 1. Specifically, the control unit 22 controls each rotation actuator 21 by the motor driver 21a so as to brake the rotation of each drive wheel 20. The control unit 22 proceeds to step S327.

[0236] In step S327, the control unit 22 determines whether the speed of the driving assistance device 1 is zero. After speed detection is started in step S301 shown in FIG. 20 , the control unit 22 receives the speed v of the driving assistance device 1 from the speed acquisition unit 20 a at predetermined intervals. x In step S327, the information of the acquired velocity v x When the running assist device 1 and the running implement 200 connected thereto stop, the speed v x is zero. The control unit 22 x If it is determined that is zero (step S327; Yes), the process of the flowchart shown in FIG. 23 ends, and the process proceeds to step S330 shown in FIG.

[0237] When the calibration process S300 is completed, as shown in Fig. 19, driving assistance control is started to assist the operator in operating the driving implement 200. In the driving assistance control, an estimation process S400 and an FSM control process S500 are repeatedly executed.

[0238] In the estimation process S400, an external force ψ acting on the traveling tool 200 due to the operation of the operator is calculated. H (Translational external force F H and rotational external force τ H In the FSM control process S500, the external force ψ applied to the traveling tool 200 by the operation of the operator is estimated. H is the driving force ψ of the driving assist device 1. R (Translational driving force F R and turning drive force τ R ) is borne instead, and the external force ψ H is zero, or the external force ψ HThe driving assist device 1 performs driving assist control so that the driving assist control is reduced. Then, the process returns to the estimation process S400, and the estimation process S400 and the FSM control process S500 are repeatedly executed until the driving assist control is terminated.

[0239] First, the estimation process S400 and the FSM control process S500 will be described in more detail. Fig. 24 is a control block diagram of the driving assistance device 1 in the estimation process S400 and the FSM control process S500.

[0240] 24, the control unit 22 controls the rotation actuator 21 corresponding to each drive wheel 20 by the motor driver 21a. The motor driver 21a supplies the rotation actuator 21 with electric power for applying a predetermined torque to each drive wheel 20. The control unit 22 also receives the acceleration a of the driving assistance device 1 from the acceleration acquisition unit 10a. x and obtains the driving force ψ by the driving assist device 1 from the sensor 120. R (Translational driving force F R and turning drive force τ R ) information.

[0241] As described above, the motor driver 21a acquires information on the number of rotations from the rotary actuators 21 and outputs the acquired information on the number of rotations to the speed acquisition unit 20a. The speed acquisition unit 20a calculates the overall speed v of the driving assistance device 1 based on the information on the number of rotations of each rotary actuator 21. x , v y , and angular velocity ω z The speed acquisition unit 20a calculates the acquired speed v x , v y , and angular velocity ω z The control unit 22 receives the information on the speed v of the driving assistance device 1 from the speed acquisition unit 20a. x , v y , and angular velocity ω z Get information about.

[0242] In the estimation process S400, first, the control unit 22 calculates the load F that the traveling assistance device 1 receives at the connection part with the traveling tool 200 from the measurement value of the sensor 120 of the connection module 100. x , Fy , F z and moment M around the Z axis z Calculate the load F x is the translational driving force F of the driving assistance device 1 R corresponds to the X-axis component of the load F y is the translational driving force F R It corresponds to the Y-axis component of the moment M z is the turning driving force τ R is equivalent to

[0243] Next, the control unit 22 calculates the driving force ψ R (Translational driving force F R and turning drive force τ R ) and the friction force ψ calculated in the calibration process S300 f (f A , f B , f C , f D ) and, based on the external force ψ H (Translational external force F H and rotational external force τ H In this embodiment, the mass M and moment of inertia I of the running tool 200 shown in the formula (12) are set to zero, and the ψ in the inertial system term in the formula (13) is set to ψ = 0, and the estimation process S400 is performed while ignoring the influence of inertia. Therefore, in the estimation process S400, the external force ψ H (Translational external force F H and rotational external force τ H ) is calculated by the following formula (14).

[0244]

[0245] In the following description, the external force ψ calculated in the estimation process S400 is used. H The estimated value of the external force ψ H * (Translational external force F H * and rotational external force τ H * ) is called the translational external force F H * That is, the external force F in the X-axis direction Hx * and the Y-axis component of the external force F Hy* Also, the external rotation force τ H * is the external force τ Hz * In the estimation process S400, the control unit 22 calculates the external force ψ H * (F Hx * , F Hy * , τ Hz * ) and proceeds to the FSM control process S500.

[0246] In the FSM control process S500, a translational driving force F for the driving assistance device 1 to travel suitably is calculated. R The translational driving force F cmd , and the turning driving force τ R The control input value of the turning drive force τ cmd Calculate the translational driving force F cmd is the translational driving force F in the X-axis direction cmdx and the Y-axis component of the translational driving force F cmdy The turning driving force τ cmd is the rotational driving force τ around the Z axis cmdz The control input values ​​of these driving forces are expressed by the following equation (15).

[0247]

[0248] The FSM control process S500 will be described in more detail. Fig. 25 is a control block diagram of the FSM control process S500. The FSM control process S500 includes a stop control S510, a drive control S520, and a braking control S530, and executes any one of these controls. Furthermore, the FSM control process S500 transitions to another control when a preset transition condition is met.

[0249] The stop control S510 is a process in which the driving assist device 1 applies a driving force ψ to the driving tool 200. R That is, in the stop control S510, the control unit 22 controls the driving force ψ of the driving assist device 1 to be not applied or to maintain that state. R In this case, the translational driving force F Rand turning drive force τ R The control input value, the driving force ψ, is set so that cmd (Translational driving force F cmd and turning drive force τ cmd ) is calculated based on the following formula (16).

[0250]

[0251] In the FSM control process S500, when the stop control S510 is being executed, if a transition condition C512 is satisfied, the process transitions to the drive control S520. The transition condition C512 is that the absolute value of the speed v of the traveling assistance device 1 connected to the traveling implement 200 does not exceed a predetermined threshold value v stop (|v|≧v stop That is, when the running assist device 1 is not applying a driving force to the running implement 200, the operator applies an external force ψ H By applying the above formula, the absolute value of the speed v of the running assist device 1 and the running implement 200 is equal to or exceeds the predetermined threshold value v stop If this is the case, the process proceeds to drive control S520.

[0252] Threshold v stop is a threshold value for determining whether the vehicle is in a running state or a stationary state during the FSM control process S500. stop is a value close to zero, which is a fixed value set in advance to allow for errors due to vibrations, etc. More specifically, in the FSM control process S500, an external force ψ unintended by the operator, such as when the operator unintentionally bumps into the running tool 200 or when vibrations are generated by placing a hand that is not operating the running tool 200, is calculated. H The threshold value v stop is set in advance to prevent such malfunctions. stop is the external force ψ applied by the operator H The threshold value v for allowing errors due to vibrations, etc., used in the calibration process S300, which is executed without being affected by x0 , v y0 , v x1 , v y1 The threshold value v is set to a value greater than stopThe larger the threshold v stop If is too small, safety will be reduced, so it is preferable to set it through trials in advance.

[0253] The drive control S520 is a control for controlling the external force ψ applied to the running tool 200 by the operator. H In response to this, the running assist device 1 applies a driving force ψ to the running implement 200. R The control unit 22 applies a driving force ψ which is a control input value. cmd (Translational driving force F cmd and turning drive force τ cmd ) is calculated based on the following formulas (17) and (18).

[0254]

[0255]

[0256] Since the driving assist device 1 assists the driving of the driving implement 200, the coefficient diagonal matrix α is cmd is the friction force ψ of the driven wheel 220 of the running implement 200 f is always kept smaller than (ψ cmd <ψ f ) is determined as follows.

[0257] As can be derived from equations (14) and (17), the driving force ψ cmd is the external force ψ H That is, the driving force ψ cmd (X-axis component of translational driving force F cmdx , Y-axis component of translational driving force F cmdy , and the rotational driving force τ of the Z-axis component cmdz ) is the external force F calculated in the estimation process S400. Hx * , F Hy * , τ Hz * and the coefficient diagonal matrix α.

[0258] In the FSM control process S500, when the drive control S520 is being executed, if a transition condition C521 is satisfied, the process transitions to the stop control S510. The transition condition C521 is a condition in which the absolute value of the speed v of the traveling assist device 1 connected to the traveling implement 200 exceeds a predetermined threshold value v stop (|v|<v stop That is, when the running assistance device 1 is running together with the running implement 200, the absolute value of the speed v of the running assistance device 1 and the running implement 200 is greater than or equal to a predetermined threshold value v stop If it is smaller, the process proceeds to stop control S510.

[0259] In the FSM control process S500, when the drive control S520 is being executed, if a transition condition C523 is satisfied, the process transitions to the braking control S530. The transition condition C523 is when the absolute value of the speed v of the traveling assistance device 1 connected to the traveling implement 200 exceeds a predetermined threshold value v stop and (|v|≧v stop ), acceleration in the X-axis direction a x The absolute value of x1 Larger than (| a x |>a x1 ), and the angular velocity ω in the rotation direction around the Z axis z The absolute value of z1 is less than or equal to (|ω z |≦ω z1 ) In this state, the velocity in the X-axis direction is v x and the acceleration a in the X-axis direction x This includes the case where the positive and negative values ​​of x a x <0).

[0260] That is, when the traveling assist device 1 and the traveling implement 200 decelerate in the X-axis direction, the process shifts from the drive control S520 to the braking control S530. Even when the traveling assist device 1 and the traveling implement 200 decelerate in the X-axis direction, the absolute value of the speed v does not exceed the predetermined threshold value v stop If the acceleration is smaller than a x The absolute value of x1 If the angular velocity ω is z The absolute value of the threshold ω z1 If the threshold value a is greater than the threshold value a, the brake control step S530 is not executed. x1 and threshold ωz1 , a positive value, which is a value that is set in advance to allow for errors due to vibrations, etc. x The absolute value of x1 If the threshold value a is greater than the threshold value a, the driving assistance device 1 is considered to be accelerating or decelerating on the X axis. x1 is the external force F in the X-axis direction when the operator intentionally tries to decelerate the driving assistance device 1. Hx * The brake is applied only when the angular velocity ω acts in the direction opposite to the traveling direction more than a predetermined value. z The absolute value of ω z1 If it is less than ω, it is considered that there is no large turning motion. z1 is provided to prevent accidental braking during a turning operation of the driving assistance device 1.

[0261] The braking control S530 is performed by controlling the speed v x and applies a brake in accordance with the external force ψ applied by the operator to the traveling tool 200 in the width direction (Y-axis direction) and the turning direction (rotation direction around the Z-axis) of the traveling tool 200. H Depending on R In the braking control S530, the viscous resistance (drag) control is applied to the brake in the X-axis direction, and the translational driving force F in the X-axis direction, which is the control input value, is applied. cmdx The control unit 22 controls the driving force ψ cmd Of these, the translational driving force F cmdx is calculated based on the following formula (19).

[0262]

[0263] In equation (20), the viscous resistance coefficient b can be arbitrarily set to virtually reproduce the viscous resistance acting on a sphere passing through a predetermined space. The radius of this sphere is r, and the dynamic viscosity coefficient of the space is μ d Then, it is expressed by the following formula (20).

[0264]

[0265] The control of the Y-axis direction and the rotation direction around the Z-axis in the braking control S530 is the same as that in the drive control S520. cmd Of these, the Y-axis component of the translational driving force F cmdy , and the rotational driving force τ of the Z-axis component cmdz are calculated based on the following formulas (21) and (22), respectively.

[0266]

[0267]

[0268] In the FSM control process S500, when the braking control S530 is being executed, if a transition condition C531 is satisfied, the process transitions to the stop control S510. The transition condition C531 is that the absolute value of the speed v of the traveling assistance device 1 connected to the traveling implement 200 does not exceed a predetermined threshold value v stop (|v|<v stop That is, when the running assistance device 1 is running together with the running implement 200, the absolute value of the speed v of the running assistance device 1 and the running implement 200 is greater than or equal to a predetermined threshold value v stop If it is smaller, the process proceeds to stop control S510.

[0269] In the FSM control process S500, when the braking control S530 is being executed, if a transition condition C532 is satisfied, the process transitions to the drive control S520. The transition condition C532 is that the absolute value of the speed v of the traveling assistance device 1 connected to the traveling implement 200 does not exceed a predetermined threshold value v stop and (|v|≧v stop ), acceleration in the X-axis direction a x The absolute value of x1 greater than (| a x |>a x1 ) In this state, the velocity in the X-axis direction is v x and the acceleration a in the X-axis direction x The positive and negative values ​​of x a x ≧0).

[0270] When the traveling assist device 1 and the traveling implement 200 accelerate in the X-axis direction, the process shifts from the braking control S530 to the driving control S520. Even when the traveling assist device 1 and the traveling implement 200 accelerate in the X-axis direction, the absolute value of the velocity v does not exceed the predetermined threshold value v stop If the acceleration is smaller than a x The absolute value of x1 If the threshold value is less than or equal to the threshold value a, the process does not proceed to the drive control S520. x1 is the external force F in the X-axis direction when the operator intentionally tries to accelerate the driving assistance device 1. Hx * The transition from the braking control S530 to the drive control S520 means that acceleration will resume during deceleration.

[0271] In the FSM control process S500, the calculated control input value ψ is used in any of the stop control S510, drive control S520, and braking control S530. cmd (Translational driving force F cmd and turning drive force τ cmd ) based on the torque value τ of each drive wheel 20 that the driving assistance device 1 realizes. wheel The control unit 22 calculates the torque value τ wheel The motor driver 21 a controls each rotation actuator 21 so that each drive wheel 20 rotates.

[0272] The estimation process S400 and FSM control process S500 described above are repeatedly executed at a predetermined cycle until the running assistance control is terminated, as shown in Fig. 19. The control unit 22 terminates the processing of the flowchart shown in Fig. 19 when, for example, the pressure sensor 160 of the running assistance device 1, which receives a predetermined operation for terminating the running assistance operation, detects that the load receiving member 130 has been disconnected from the attachment member 150 attached to the running tool 200. When the control unit 22 temporarily stops the running assistance operation, it may save the results of the calibration process S300 and omit the calibration process S300 when the running assistance operation is resumed.

[0273] As described above, the running assistance device 1 of the embodiment includes the driving wheels 20 supported by the device main body 10 to drive the device main body 10, the speed acquisition unit 20a that acquires information on the speed v and angular velocity ω of the device main body 10, and a running implement 200 that is connected to the running implement 200 and includes a main body 210 and a plurality of driven wheels 220 supported by the main body 210. x , F y , τ z and a connection portion (load receiving member 130 and mounting member 150) that receives the driving force ψ from the driving wheel 20. R and a control unit 22. The control unit 22 applies an external force ψ to the running tool 200. H Driving force ψ when no force is applied R The friction force ψ of the driven wheel 220 is f is calculated, and the speed v of the device main body 10 is set to a predetermined threshold value v stop If the friction force ψ f Driving force ψ against cmd The driving wheels 20 are controlled to travel at a speed v of the device main body 10 and the speed v of the device main body 10 reaches a predetermined threshold value v stop If it is smaller, the driving force ψ of the driving wheel 20 cmd is controlled to be zero.

[0274] According to this, a dedicated operating unit is not required, and the friction force ψ applied to the running tool 200 via the driven wheel 220 is f By reducing the load due to the external force ψ applied by the operator to propel the running tool 200, H Furthermore, the running assistance device 1 can be connected to and detached from existing running tools 200 at the connection parts (the load receiving member 130 and the attachment member 150), and is therefore applicable to a variety of running tools 200. Furthermore, the frictional force ψ acting on the running tool 200 carrying the transport object can be reduced. f Therefore, even if different weights of objects are loaded, the corresponding friction force ψ f Driving force ψ cmd Furthermore, by classifying conditions based on the speed information acquired by the speed acquisition unit 20a, it is possible to transition to and execute a suitable control, whether to provide control for assisting driving or not.

[0275] In the driving assistance device according to one aspect of the present invention, the control unit 22 calculates the driving force ψ R and friction force ψ f The external force ψ acting on the running implement 200 based on H (Translational external force F H , turning external force τ H ) (external force ψ H * ) is calculated, and the velocity v of the device main body 10 is set to a predetermined threshold value v stop If the external force ψ H Based on the external force ψ H A driving force ψ that reduces cmd Calculate the driving force ψ cmd The driving wheels 20 are controlled to travel at a speed v of the device main body 10 and the speed v of the device main body 10 reaches a predetermined threshold value v stop If it is smaller, the driving force ψ of the driving wheel 20 cmd is controlled to be zero.

[0276] This allows the operator to apply an external force (translational external force F H , turning external force τ H ) in the direction of the friction force ψ acting on the running tool 200, thereby reducing the burden on the operator. Even without a dedicated operating unit, the operator can directly operate the running tool 200 by grasping any part of the running tool 200 with their hands, eliminating the need for special training to operate the running assist device 1, and enabling the running tool 200 to perform delicate movements even in a small space or crowded environment. In addition, the friction force ψ acting on the running tool 200 carrying the object to be transported is also reduced. f is calculated, the friction force ψ of the traveling device 200 including the transport object f Assuming that, the friction force ψ f and driving force ψ R Therefore, the external force applied by the operator operating the traveling implement 200 is estimated and the traveling implement 200 is controlled to reduce this external force, so that traveling assistance control corresponding to different weights of transport objects can be performed.

[0277] In the driving assistance device 1 of the embodiment, the control unit 22 determines whether the speed v of the device main body 10 is greater than or equal to a predetermined threshold v stop If the external force ψ H and is proportional to the external force ψ HSmaller driving force ψ cmd Calculate the driving force ψ cmd The driving wheels 20 are controlled to run.

[0278] As a result, the external force ψ H As the value of ψ increases, the driving force ψ R becomes proportionally larger, allowing the operator to perform intuitive operation.

[0279] The driving assistance device 1 of the embodiment further includes an acceleration acquisition unit 10 a that acquires information on the acceleration a of the device main body 10. In the driving assistance device 1, the control unit 22 determines whether the speed v of the device main body 10 is greater than or equal to a predetermined threshold v stop In the case where the acceleration a x acts in the direction opposite to the traveling direction, and the acceleration a is greater than or equal to a predetermined threshold a x1 If the value is equal to or greater than the above, the braking force calculated by multiplying the velocity v and the angular velocity ω by a predetermined viscosity resistance coefficient b is equal to the driving force ψ cmd and the driving force ψ cmd The control is changed so that the drive wheels 20 run.

[0280] This suppresses vibration when the velocity v and angular velocity ω are small, and increases the braking force at high speeds. Therefore, for example, when the traveling tool 200 is about to come into contact with an obstacle, it can instantly decelerate and stop while reducing the burden on the transport target.

[0281] In the driving assistance device 1 of the embodiment, the control unit 22 converts the braking force into the driving force ψ cmd When the speed v of the device main body 10 is controlled as follows, stop If it is smaller, the driving force ψ of the driving wheel 20 cmd Change the control so that is zero.

[0282] This allows the control to be switched to and executed as appropriate, either a control that provides braking assistance (braking control S530) or a control that provides neither driving assistance nor braking assistance (stop control S510), based on conditions determined based on the speed information acquired by the acceleration acquisition unit 10a.

[0283] In the driving assistance device 1 of the embodiment, the control unit 22 converts the braking force into the driving force ψ cmd In the state where the acceleration a applied to the device body 10 is x acts in the direction of travel, and the acceleration a x is a predetermined threshold a x1 If the external force ψ H Based on the external force ψ H A driving force ψ that reduces cmd The control is changed so that the drive wheels 20 run.

[0284] According to this, by classifying conditions based on the speed information acquired by the acceleration acquisition unit 10a, it is possible to switch to a more appropriate control, or to continue the control, such as control to restart driving assistance (driving control S520) or control to continue braking (braking control S530).

[0285] In the running assist device 1 of the embodiment, the driven wheel 220 of the running tool 200 is a swivel wheel.

[0286] When starting, the load on the operator is smallest when the free wheel is pushed in a horizontal direction perpendicular to the axial direction of the free wheel, and is largest when the free wheel is pushed in the axial direction. f Driving force ψ against the load due to cmd This reduces the load on the operator when starting to move, and allows the running tool 200 to easily start moving even when a load is applied in the axial direction of the swivel wheel.

[0287] In the running assist device 1 of the embodiment, the control unit 22 aligns the directions of the multiple driven wheels 220 by running the running tool 200 in one direction (the positive direction of the Y axis), and then aligns the directions of the multiple driven wheels 220 again by running the running tool 200 in an intersecting direction (the positive direction of the X axis) perpendicular to the one direction, and further applies a driving force (translational driving force F Rx ) and start driving R The friction force ψ of the driven wheel 220 is f Calculate the maximum static friction force as

[0288] According to this, when the vehicle starts to move, the driven wheel 220 turns or a load is applied in the axial direction of the driven wheel 220, so that the friction force ψ f In addition, the friction force ψ used in the driving assist control can be prevented from being calculated excessively. f By setting the value of this as the maximum static friction force, it is possible to reduce the large load when starting from a stationary state.

[0289] In the running assist device 1 of the embodiment, the control unit 22 aligns the directions of the multiple driven wheels 220 by running the running tool 200 in one direction (in the embodiment, the Y-axis direction), and then aligns the directions of the multiple driven wheels 220 again by running the running tool 200 in an intersecting direction (in the embodiment, the X-axis direction) perpendicular to the one direction, and further applies a driving force ψ to the driving wheels 20 in the intersecting direction. R The driving force ψ when the vehicle is traveling at a constant speed v R The friction force ψ of the driven wheel 220 is f Calculate the kinetic friction force as

[0290] According to this, the driven wheel 220, which was facing in the opposite direction before the vehicle started to move, turns during the vehicle, and a load is applied to the driven wheel 220 in the axial direction, so that the friction force ψ f In addition, the friction force ψ used in the driving assist control can be prevented from being calculated excessively. f By using the value of kinetic friction as the friction force, the friction force ψ acting during running f Therefore, the load can be reduced by approximately the same amount as that caused by the

[0291] In the driving assistance device 1 of the embodiment, the driving force acquisition unit 10b acquires the load F x , F y , τ z The sensor 120 (load sensor) detects the load F x , F y , τ z is the driving force ψ of the driving assist device 1. R (Translational driving force F Rx , F Ry and turning drive force τ Rz ) shall be considered.

[0292] In this way, when the running assistance device 1 carries the running implement 200, the load F applied to the connection portion (the load receiving member 130 and the attachment member 150) is x , F y , τ z is the force with which the running assist device 1 pushes the running implement 200, and therefore the driving force ψ of the running assist device 1 R Therefore, the sensor 120 (load sensor) for detecting whether the connection state between the running assist device 1 and the running implement 200 is normal or not can also be used as the driving force acquisition means.

[0293] The driving assistance device 1 of the embodiment includes a base 131 that is square in shape in a plan view, and the sensor 120 (load sensor) includes a plurality of sensors 120 attached to a sensor attachment member 110 having a groove (pin leg accommodating groove 112) that accommodates the base 131 of the connection portion (load receiving member 130), and the plurality of sensors 120 are arranged on either side of the base 131 in a first direction (Y-axis direction) of a plane (XY plane) that intersects with the axial direction, and are in contact with the base 131 to receive a first measurement value (differential output voltage value V S1± , V S2± ), and a first sensor group (first positive sensor 121p and second positive sensor 122p, first negative sensor 121n and second negative sensor 122n) that measures a second measurement value (differential output voltage value V S3± , V S4± ), and a third measurement value (output voltage value V S5+ , V S6+ and a third sensor group (fifth sensor 125 and sixth sensor 126) that measures the temperature.

[0294] The connection part (load receiving member 130) that receives the load from the running tool 200 is supported at its four side surfaces and bottom surface (top surface of the recessed part 134) via a plurality of sensors 120 attached to the sensor attachment member 110, and the plurality of sensors 120 measure first, second, and third measurement values ​​corresponding to the displacement of the connection part in the first, second, and third directions. According to this, for example, the control unit 22 calculates the load F of the three axes based on the respective measurement values ​​measured by the sensors 120. x , F y , F z Therefore, the running assistance device 1 can measure each measurement value for calculating the load applied from the running tool 200 separately along three axes. Furthermore, the running assistance device 1 is not limited to a material for the sensor mounting member 110 to which the sensor 120 is attached.

[0295] In addition, in the driving assistance device 1 of the embodiment, the first sensor groups (the first positive sensor 121p and the second positive sensor 122p, the first negative sensor 121n and the second negative sensor 122n) are provided in pairs on each of two side surfaces of the base 131 facing each other in the first direction (Y-axis direction), and each of the first sensor groups outputs a first measurement value (differential output voltage value V S1± , V S2± ) to measure two first measurement values, and second sensor groups (third positive sensor 123p and fourth positive sensor 124p, third negative sensor 123n and fourth negative sensor 124n) are provided in pairs on two side surfaces of base 131 facing each other in the second direction (X-axis direction), and each second sensor group measures a second measurement value (differential output voltage value V S3± , V S4± ) to obtain two second measurements.

[0296] In the driving assistance device 1, when a moment is applied to the connection part (load receiving member 130) in a rotation direction (θ rotation direction) around the third direction (Z axis), two sensors located diagonally out of the four sensors 120 arranged on opposing side surfaces of the base part 131 are pressed. Therefore, by arranging two sensors on each side surface of the base part 131, for example, the control part 22 can calculate the moment M around the third direction based on each measurement value measured by the sensor 120, the distance to the sensor 120, and the rotation angle around the third direction. zThat is, the running assist device 1 can measure each of the measured values ​​for calculating the load applied from the running tool 200 separately along four axes.

[0297] In the driving assistance device 1 of the embodiment, the control unit 22 calculates the first measurement value (differential output voltage value V S1± , V S2± ), and the second measurement value (differential output voltage value V S3± , V S4± ), and the third measurement value (output voltage value V S5+ , V S6+ ) and based on this, the triaxial load F applied to the connection part (load receiving member 130) x , F y , F z is calculated, and a moment M acting on the connection part about the third direction is calculated based on the first measurement value, the second measurement value, the distance L from a predetermined origin of the connection part (load receiving member 130) to the contact point between the base part 131 and the sensor 120, and the rotation angle φ of the connection part about the third direction (Z-axis direction). z Among the calculated loads on the three axes, the load F applied in the first direction (Y-axis direction) and the second direction (X-axis direction) is calculated. y , F x and the moment M around the third direction (Z-axis direction) z and the driving force of the driving assist device 1 (translational driving force F R , turning drive force τ R ) shall be considered.

[0298] When the running aid 200 is connected, the running aid 1 applies a load from the running aid 200 to the connection part (the load receiving member 130 via the attachment member 150), and measures a first measurement value, a second measurement value, and a third measurement value corresponding to the displacement of the connection part (the load receiving member 130) that is displaced by the load applied from the running aid 200. Based on each measurement value, the running aid 1 calculates the load F on the three axes by the control unit 22. x , F y , F zFurthermore, when a moment is applied to the connection part (load receiving member 130) in the rotation direction around the third direction (θ rotation direction), two sensors 120 located diagonally out of the four sensors 120 arranged on opposing side surfaces of the base part 131 are pressed. Therefore, by arranging two sensors 120 on each side surface of the base part 131, the driving assistance device 1 can calculate the moment M around the third direction by the control part 22 based on each measurement value, the distance to the sensor 120, and the rotation angle φ around the third direction. z As a result, the driving assistance device 1 can calculate the load F applied in the first direction, the second direction, and the third direction. x , F y , F z In addition, the moment M around the third direction z Then, the load F applied in the first direction and the second direction can be calculated. y , F x The translational driving force F R , moment M about the third direction z Turning driving force τ R Based on this, the external force (translational external force F H , turning external force τ H ) can be calculated.

[0299] Furthermore, in the embodiment of the driving assistance device 1, the sensor 120 has an outer frame 120a which is a rectangular ring-shaped plate, a tongue 120b which is a rectangular plate connected to one side of the inner peripheral edge of the outer frame 120a and provided on the inner peripheral side of the outer frame 120a, and a protrusion 120c which protrudes from one surface of the tongue 120b and contacts the base 131, and the two sensors 120 which support the same side of the base 131 are attached to the sensor mounting member 110 so that the positions of the protrusions 120c in the third direction (Z-axis direction) are offset from each other.

[0300] This allows the points that support the side of the base 131 to vary in the third direction, thereby preventing unintended rotation of the connection part (load-receiving member 130) including the base 131 relative to the sensor mounting member 110.

[0301] In addition, in the embodiment of the running assistance device 1, the connection portion comprises a load-receiving member 130 including a base 131 having a square shape in a plan view and a connection pin portion 132 protruding from an upper surface 131a of the base 131 and extending in the axial direction (Z-axis direction), and an attachment member 150 attached to the running tool 200 and having an engagement hole 154 into which the connection pin portion 132 can be inserted.

[0302] The running assistance device 1 has a load-receiving member 130 which has a connection pin portion 132, and an attachment member 150 which is attached to the running tool 200 which has an engagement hole 154 into which the connection pin portion 132 can be inserted, so that the running assistance device 1 can be easily connected to and disconnected from the running tool 200.

[0303] Furthermore, in the embodiment of the driving assistance device 1, the connection pin portion 132 includes at its upper end a first pillar portion 132a whose shape when viewed in the axial direction (Z-axis direction) is other than a perfect circle, and the fitting hole 154 has a first hole portion 154a, a second hole portion 154b, and a third hole portion 154c which are connected in order, and the first hole portion 154a has a tapered inner wall which gradually becomes smaller towards the second hole portion 154b, and the second hole portion 154b has a tapered inner wall which gradually becomes smaller towards the third hole portion 154c and has a taper ratio which is smaller than the taper ratio of the first hole portion 154a, and the third hole portion 154c can be fitted with the first pillar portion 132a of the connection pin portion 132.

[0304] According to this, when positioning the load receiving member 130 and the mounting member 150, the connection portion of the travel assistance device 1 positions the load receiving member 130 in two axial directions (X-axis and Y-axis directions) on a plane intersecting the axial direction at the first hole portion 154a, positions the load receiving member 130 in a rotational direction about the axial direction (θ rotation direction) at the second hole portion 154b, and positions the load receiving member 130 in one axial direction (Z-axis direction) by fitting the load receiving member 130 in the first hole portion 154a, thereby enabling positioning along four axes using only a combination of one set of fitting holes 154 and connection pin portion 132. Furthermore, when the load receiving member 130 moves in the direction of the second hole portion 154b relative to the mounting member 150 through the first hole portion 154a, one angular portion 132c on the upper edge of the first pillar portion 132a comes into contact with the inner wall of the first hole portion 154a and is guided by the inner wall, thereby moving toward the radial center. Furthermore, when the load-receiving member 130 moves in the second hole portion 154b toward the third hole portion 154c relative to the mounting member 150, the angular portions 132c located at both ends of the major axis of the first column portion 132a are guided toward the angular portions of the second hole portion 154b while contacting the inner walls of the second hole portion 154b, causing the load-receiving member 130 to rotate about the axis. In other words, by simply inserting the connection pin portion 132 into the fitting hole 154 from a state in which the connection pin portion 132 and the fitting hole 154 are opposed to each other, the connection portion is sequentially positioned in two axial directions on a plane intersecting the axial direction, in a rotational direction around the axial direction, and in one axial direction, thereby easily positioning along four axes.

[0305] Furthermore, the running assistance device 1 of the embodiment comprises a sliding member 30 that is movable in one direction relative to the device main body 10 (for example, in the front-to-rear direction of the device main body 10), a lifting mechanism 40 that connects the device main body 10 and the load-receiving member 130 and raises and lowers the load-receiving member 130 relative to the device main body 10 as the sliding member 30 moves, and a linear actuator 50 that moves the sliding member 30 in one direction relative to the device main body 10, and the load-receiving member 130 rises from below the mounting member 150 fixed to the underside of the main body 210, thereby being able to hold the running tool 200 via the mounting member 150, and can be detached from the mounting member 150 and the running tool 200 by descending.

[0306] According to this, the running assistance device 1 slips under the running implement 200, and the load-receiving member 130 connects from below to the attachment member 150 attached to the running implement 200, making it easy to turn right or left, rotate, and switch between forward and reverse, allowing for stable running. Furthermore, when slipping under the running implement 200 before connecting to it, the load-receiving member 130 can be lowered to reduce the overall height of the running assistance device 1, making it compatible with low-floor running implements 200. Furthermore, lowering the load-receiving member 130 easily releases the connection with the attachment member 150 attached to the running implement 200, so if multiple attachment members 150 are attached to multiple running implements 200 in advance, multiple running implements 200 can be transported one after another.

[0307] The driving assistance control method of the embodiment also includes a driving wheel 20 supported by the device main body 10 to drive the device main body 10, a speed acquisition unit 20a that acquires information on the speed v and angular velocity ω of the device main body 10, and a load F applied from the driving wheel 200 to the driving tool 200, the load F being connected to the driving tool 200 and including a main body 210 and a plurality of driven wheels 220 supported by the main body 210. x , F y , τ z and a connection portion (load receiving member 130 and mounting member 150) that receives the driving force ψ from the driving wheel 20. R and a driving force acquisition unit that acquires a driving force by applying an external force ψ to the running implement. H Driving force ψ when no force is applied R Based on this, the friction force ψ of the driven wheel 220 f and an FSM control process S500, which calculates the friction force ψ f Driving force ψ against cmd A drive control S520 controls the drive wheels 20 to travel at a drive force ψ cmdand a stop control S510 for controlling the drive control S520 so that the value of the drive control S520 is zero. In the FSM control process S500, if a first condition (transition condition C521) is satisfied in the drive control S520, the process transitions from the drive control S520 to the stop control S510, and if a second condition (transition condition C512) is satisfied in the stop control S510, the process transitions from the stop control S510 to the drive control S520.

[0308] This allows the frictional force ψ applied to the running tool 200 via the driven wheel 220 to be controlled without requiring a dedicated operating unit. f By reducing the load due to the external force ψ applied by the operator to propel the running tool 200, H Furthermore, the running assistance device 1 can be connected to and detached from existing running tools 200 at the connection parts (the load receiving member 130 and the attachment member 150), and is therefore applicable to a variety of running tools 200. Furthermore, the frictional force ψ acting on the running tool 200 carrying the transport object can be reduced. f Therefore, even if different weights of objects are loaded, the corresponding friction force ψ f Driving force ψ cmd Furthermore, by classifying conditions based on the speed information acquired by the speed acquisition unit 20a, it is possible to transition to and execute a suitable control, whether to provide control for assisting driving or not.

[0309] In the driving assistance control method of the embodiment, the first condition (transition condition C521) is that the speed v of the device main body 10 is greater than or equal to a predetermined threshold v stop The second condition (transition condition C512) is that the speed v of the device main body 10 is smaller than a predetermined threshold v stop This includes becoming more than that.

[0310] This allows the control unit 20a to transition to and execute the appropriate control, either a control that assists driving (drive control S520) or a control that does not assist driving (stop control S510), based on conditions determined based on the speed information acquired by the speed acquisition unit 20a.

[0311] A driving assistance control method according to one aspect of the present invention comprises: R and friction force ψ f Based on this, the external force ψ acting on the running tool 200 is calculated. HEstimated value of (external force ψ H * The estimation process S400 and the FSM control process S500 are repeatedly executed, and in the drive control S520, the external force ψ H Based on the external force ψ H A driving force ψ that reduces cmd Calculate the driving force ψ cmd In the stop control S510, the driving force ψ of the driving wheels 20 is controlled. cmd is controlled to be zero.

[0312] According to this, the operator can input an external force (translational external force F H , turning external force τ H ) and reduces the burden on the operator. Even without a dedicated operating unit, the operator can directly operate the running tool 200 by grasping any part of the running tool 200 with their hands, eliminating the need for special training to operate the running assistance device 1, and enabling the running tool 200 to move with precision even in a small space or crowded environment. In addition, the frictional force ψ acting on the running tool 200 carrying the transport object is reduced. f is calculated, the friction force ψ of the traveling device 200 including the transport object f Assuming that, the friction force ψ f and driving force ψ R Therefore, the external force applied by the operator operating the traveling implement 200 is estimated and the traveling implement 200 is controlled to reduce this external force, so that traveling assistance control corresponding to different weights of transport objects can be performed.

[0313] In the cruise assist control method of the embodiment, the FSM control process S500 converts the braking force calculated by multiplying the velocity v and the angular velocity ω by a predetermined viscosity resistance coefficient b into the driving force ψ cmd and the driving force ψ cmdIn the FSM control process, if a third condition (transition condition C523) is satisfied in the drive control S520, the process transitions from the drive control S520 to the brake control S530, if a fourth condition (transition condition C532) is satisfied in the brake control S530, the process transitions from the brake control S530 to the drive control S520, and if a fifth condition (transition condition C531) is satisfied in the brake control S530, the process transitions from the brake control S530 to the stop control S510.

[0314] This allows vibration to be suppressed when the velocity v and angular velocity ω are small, and allows for increased braking force at high speeds. Therefore, for example, when the traveling tool 200 is about to come into contact with an obstacle, it is possible to instantly decelerate and stop the traveling tool 200 while reducing the burden on the transport target. Furthermore, based on the conditions, it is possible to transition to and execute the appropriate control, such as control to assist traveling (drive control S520), control not to assist traveling (stop control S510), or control to apply the brakes (braking control S530).

[0315] In the driving assistance control method of the embodiment, the driving assistance device 1 further includes an acceleration acquisition unit 10a that acquires information on the acceleration a of the device main body 10, and the third condition (transition condition C523) is x acts in the direction opposite to the running direction, and the acceleration a x is a predetermined threshold a x1 The fourth condition (transition condition C532) is that the acceleration a applied to the device body 10 is greater than or equal to the acceleration a x acts in the direction of travel, and the acceleration a x is a predetermined threshold a x1 The fifth condition (transition condition C531) is that the speed v of the device main body 10 is equal to or greater than a predetermined threshold v stop Including becoming smaller.

[0316] This allows the control unit 20a to select a suitable control or continue to execute the control by classifying conditions based on the speed information acquired by the speed acquisition unit 20a, such as control to assist driving again (drive control S520), control not to assist driving (stop control S510), or control to continue braking (braking control S530).

[0317] It should be noted that this embodiment is not limited to the above-described embodiment, and can be modified in various ways without departing from the gist of this embodiment.

[0318] For example, in the embodiment, in addition to the load in the X-axis direction and the Y-axis direction and the moment of inertia about the Z-axis, the load in the Z-axis direction can also be detected. However, as long as at least the load in the X-axis direction and the Y-axis direction and the moment of inertia about the Z-axis can be detected, the type, number, arrangement, and combination of force sensors are not limited.

[0319] Furthermore, although the embodiment has been described as a travel assistance device 1 that is capable of moving in all directions, the embodiment can also be applied to a device in which the travel assistance device 1 travels on a rail in only one axial direction (X-axis direction). In this case, load detection at the connection portion only needs to detect the positive / negative and magnitude of the load applied in the axial direction, and speed detection only needs to detect the speed in the axial direction.

[0320] Furthermore, the outer shapes of the sensor mounting member 110, cover member 140, and mounting member 150 in a plan view are not limited to a square shape, and may be rectangular, triangular, circular, etc. Furthermore, in the embodiment, the sensor mounting member 110 and cover member 140 and the mounting member 150 and running tool 200 are fixed to each other using screws, which are highly versatile for use with existing products, but a new attachment structure may also be provided for fixation. Furthermore, the material of the sensor mounting member 110's mounting portion for the sensor 120 is not particularly limited, and various materials such as PLA, aluminum, and SUS may be used.

[0321] Furthermore, the connection module 100 is not limited to the embodiment in which the raisable load-receiving member 130 and the attachment member 150 attached to the running tool 200 are separable, and may include a magnet or suction cup that is attracted to the underside of the running tool 200 by being raised from below the running tool 200, or may be connected by being fixed to the running tool 200 with screws or the like. The sensor 120 is supported on the device main body 10 side, but may be attached to the running tool 200 side as long as it is configured to acquire the load acting on the connection part.

[0322] Furthermore, the control unit 22 may include a calculation processing device of the speed acquisition unit 20a, and the control unit 22 may convert the rotation speed of the rotation actuator 21 into the speed v and angular velocity ω of the entire driving assistance device 1. That is, the control unit 22 may calculate the speed v and angular velocity ω of the entire driving assistance device 1 based on the measurement results of the rotation speed by the rotary encoder of the rotation actuator 21.

[0323] In the embodiment, in the calibration process S300, the friction force ψ of the driven wheel 220 of the traveling tool 200 is calculated. f (f A , f B , f C , f D ) was calculated as the maximum static friction force when the running assist device 1 and the running tool 200 start moving from a stationary state, but it is also possible to calculate the kinetic friction force when the running assist device 1 and the running tool 200 are running at a constant speed. In this case, after the driven wheels 220 of the running tool 200 are aligned in the front-to-rear direction (X-axis direction) in step S310, the running tool 200 starts moving forward (X-axis direction) and runs at a constant speed.

[0324] At this time, the driving force ψ applied to the driving assistance device 1 R is the translational driving force F in the X-axis direction RX Since the driven wheel 220 is aligned in the X-axis direction, the equation (7) can be rearranged in terms of only one axis direction, the X-axis direction. The differential value of the velocity v, which is a constant velocity, is zero, and the translational external force F H is zero, the dynamic friction force is calculated as f A = f B = f C = f D =-F R / 4 can be calculated.

[0325] Regarding the transition condition C512 for transitioning from the stop control S510 to the drive control S520 in the FSM control process S500, since there are few situations in which the start of the movement is only a turning operation, in the embodiment, a threshold value is set only for the translational velocity v, but also for the angular velocity ω z A threshold may also be set for

[0326] In addition, in the braking control S530 in the FSM control process S500 of the embodiment, viscosity resistance control is applied only to control in the X-axis direction, but viscosity resistance control may also be applied to control around the Y-axis and Z-axis directions.

[0327] In the embodiment, the load acting on the connection part obtained by the sensor 120 is used as the driving force ψ of the driving assist device 1. R However, for example, the driving force ψ is calculated from the current value of the rotation actuator 21 (motor) of the driving wheel 20. R In this case, in step S321 of the calibration process S300, detection of the current value of the rotation actuator 21 (motor) of the drive wheel 20 is started instead of detecting the load applied to the connection portion, and in step S324, a driving force calculated from the current value is acquired instead of the measured value of the load applied to the connection portion. In other words, the driving force acquisition unit does not necessarily have to include the sensor 120.

[0328] In addition, the external force ψ H The estimation process S400 for estimating the driving force ψ may be omitted, and the drag due to the frictional force may be reduced to zero or reduced in the drive control S520 of the FSM control process S500. cmd (Translational driving force F cmd and turning drive force τ cmd ) is calculated based on the following formula (23) instead of the above formula (17).

[0329]

[0330] Furthermore, in the driving assistance control method of this embodiment, the load caused by the influence of gravity may be reduced. The direction and magnitude of the gravitational acceleration can be acquired by the acceleration acquisition unit 10a. In this case, gravity is expressed as ψ G Then, the inertial system ψ is expressed by the following equation (24) instead of the above equation (13).

[0331]

[0332] In the drive control S520 of the FSM control process S500, the control unit 22 calculates the drive force ψ, which is a control input value.cmd (Translational driving force F cmd and turning drive force τ cmd ) is calculated based on the following formula (25) instead of the above formula (17).

[0333]

[0334] REFERENCE SIGNS LIST 1 Travel assistance device 10 Device body 10a Acceleration acquisition unit 10b Driving force acquisition unit 11 Base 11a Opening for drive wheel 12 Drive wheel support unit 13 Actuator support unit 15 Cover member 15a Opening for lifting mechanism 15b Upper surface 20 Drive wheel 20a Speed ​​acquisition unit 21 Rotational actuator 21a Motor driver 22 Control unit 22a Load calculation unit 23 Battery 24 Emergency stop button 25 Relay switch 30 Sliding member 31 Guide shaft portion 32 Fixed portion 33 Concave portion 40 Lifting mechanism 41 Base fixing portion 41a Shaft hole 41b Guide hole 42 Connection mechanism fixing portion 42a Shaft hole 42b Guide hole 43 First link arm 43a Rotating shaft member 43b Sliding shaft member 44 Second link arm 44a Rotating shaft member 44b Sliding shaft member 45 Central shaft member 50 Linear actuator 51 Fixed portion 52 Movable portion 100 Connection module 110 Sensor mounting member 110a, 110b Top surface 111 Cover fixing screw hole 112 Pin leg accommodating groove portion 112a Bottom surface 113 Sensor mounting slit 113a Sensor opening 114 Sensor mounting recess 114a Claw portion 115 Wiring hole 120 Sensor (load sensor) 120a Outer frame 120b Tongue 120c Protrusion 121p First positive sensor 121n First negative sensor 122p Second positive sensor 122n Second negative sensor 123p Third positive sensor 123n Third negative sensor 124p Fourth positive sensor 124n Fourth negative sensor 125 Fifth sensor 126 Sixth sensor 130 Load receiving member (connection portion) 131 Base 131a Upper surface 131b Lower surface 132 Connection pin portion 132a First pillar portion 132b Second pillar portion 132c Angular portion 132d Upper surface 133, 134 Concave portion 135 Leg portion 140 Cover member 141 Fixing screw hole 142 Sensor hole 143 Pin opening 144 Pressing pin through hole 145 Wiring hole 150 Mounting member (connection portion) 151 Base 151a Upper surface 151b Lower surface 152 Hole forming portion 152a Lower edge 153 Fixing hole 154 Fitting hole154a First hole portion 154b Second hole portion 154c Third hole portion 154d Angular portion 155 Pressing pin 160 Pressure sensor 170 Cushioning material 200 Running implement 210 Main body portion 220 Driven wheel 230 Guide member 231 First arm 232 Second arm 240 Stopper 250 Handle

Claims

1. A running assistance device comprising: a drive wheel supported by a device main body to run the device main body; a speed acquisition unit that acquires information on the speed and angular velocity of the device main body; a connection unit that connects to a running implement comprising a main body and a plurality of driven wheels supported on the main body and receives a load from the running implement; a drive force acquisition unit that acquires the drive force by the drive wheels; and a control unit, wherein the control unit calculates a frictional force of the driven wheels based on the drive force in a state in which no external force is applied to the running implement, controls the drive wheels to run with a drive force that resists the frictional force when the speed of the device main body is equal to or greater than a predetermined threshold, and controls the drive force of the drive wheels to be zero when the speed of the device main body is less than the predetermined threshold.

2. The driving assistance device described in claim 1, wherein the control unit calculates an estimate of the external force acting on the running implement based on the driving force and the frictional force, and when the speed of the device body is equal to or greater than a predetermined threshold, calculates a driving force such as to reduce the external force based on the external force and controls the driving wheels to run with said driving force, and when the speed of the device body is less than a predetermined threshold, controls the driving force of the driving wheels to be zero.

3. The driving assistance device according to claim 2, wherein the control unit calculates a driving force proportional to and smaller than the external force when the speed of the device body is equal to or greater than a predetermined threshold, and controls the driving wheels to travel with the calculated driving force.

4. A driving assistance device as described in claim 1, further comprising an acceleration acquisition unit that acquires information on the acceleration of the device body, wherein the control unit, when the speed of the device body is equal to or greater than a predetermined threshold, the acceleration applied to the device body acts in a direction opposite to the direction of travel, and the acceleration is equal to or greater than the predetermined threshold, uses a braking force calculated by multiplying the speed and the angular velocity by a predetermined viscous resistance coefficient as a driving force, and changes control so that the drive wheels travel with the driving force.

5. The driving assistance device according to claim 4, wherein the control unit, in a state in which the braking force is controlled as a driving force, changes control so that the driving force of the driving wheels is set to zero when the speed of the device body is lower than a predetermined threshold value.

6. The driving assistance device according to claim 4, wherein, in a state in which the braking force is controlled as a driving force, when acceleration applied to the device body acts in the driving direction and the acceleration is equal to or greater than a predetermined threshold value, the control unit changes control so that the drive wheels travel with a driving force that reduces the external force based on the external force.

7. The running assistance device according to claim 1, wherein the driven wheels of the running implement are swivel wheels.

8. The driving assistance device according to claim 7, wherein the control unit aligns the directions of the multiple driven wheels by moving the running equipment in one direction, and then aligns the directions of the multiple driven wheels again by moving the running equipment in an intersecting direction perpendicular to the one direction, and further calculates a maximum static friction force as the friction force of the driven wheels based on the driving force at the time when the driving force in the intersecting direction is applied to the driving wheels and the driving wheels start to move.

9. The driving assistance device of claim 7, wherein the control unit aligns the directions of the multiple driven wheels by traveling the running equipment in one direction, and then aligns the directions of the multiple driven wheels again by traveling the running equipment in an intersecting direction perpendicular to the one direction, and further calculates a kinetic friction force as the friction force of the driven wheels based on the driving force when a driving force in the intersecting direction is applied to the drive wheels to travel at a constant speed.

10. A driving assistance device according to any one of claims 1 to 9, wherein the driving force acquisition unit includes a load sensor that detects the load applied to the connection portion, and the load detected by the load sensor is regarded as the driving force of the driving assistance device.

11. A driving assistance device as described in claim 10, wherein the connection portion includes a base that is square in a planar view, and the load sensor includes a plurality of load sensors attached to a sensor mounting member having a groove that accommodates the base of the connection portion, and the plurality of load sensors include: a first sensor group arranged on either side of the base in a first direction of a plane intersecting the axial direction and in contact with the base to measure a first measurement value responsive to displacement of the base, a second sensor group arranged on either side of the base in a second direction of the plane intersecting the first direction and in contact with the base to measure a second measurement value responsive to displacement of the base, and a third sensor group arranged on either side of the base in a second direction of the plane intersecting the first direction and in contact with the base to measure a third measurement value responsive to displacement of the base in a third direction along the axial direction.

12. The driving assistance device described in claim 11, wherein the first sensor groups are provided in pairs on each of two side surfaces of the base facing the first direction, and each of the first sensor groups measures the first measurement value to thereby measure the two first measurement values, and the second sensor groups are provided in pairs on each of two side surfaces of the base facing the second direction, and each of the second sensor groups measures the second measurement value to thereby measure the two second measurement values.

13. The driving assistance device according to claim 12, wherein the control unit calculates three-axial loads acting on the connection part based on the first measurement value, the second measurement value, and the third measurement value, calculates a moment acting on the connection part about the third direction based on the first measurement value, the second measurement value, a distance from a predetermined origin of the connection part to the contact point between the base part and the load sensor, and a rotation angle of the connection part about the third direction, and regards the loads acting in the first and second directions and the moment about the third direction, of the calculated three-axial loads, as driving forces for the driving assistance device.

14. A driving assistance device as described in claim 12, wherein the load sensor has an outer frame which is a square ring-shaped plate, a tongue which is a square plate connected to one side of the inner peripheral edge of the outer frame and provided on the inner peripheral side of the outer frame, and a protrusion which protrudes from one face of the tongue and contacts the base, and wherein two load sensors supporting the same side of the base are attached to the sensor mounting member such that the positions of the protrusions are offset from each other in the third direction.

15. The running assistance device described in claim 10, wherein the connection portion comprises: a load-receiving member including a base portion having a square shape in a plan view and a connection pin portion protruding from an upper surface of the base and extending in the axial direction; and an attachment member attached to the running tool and having a fitting hole into which the connection pin portion can be inserted.

16. The driving assistance device described in claim 15, wherein the connection pin portion includes a first column portion at an upper end, the first column portion having a shape other than a perfect circle when viewed in the axial direction, the fitting hole is a first hole portion, a second hole portion, and a third hole portion which are connected in sequence, the first hole portion has a tapered inner wall which gradually becomes smaller toward the second hole portion, the second hole portion has a tapered inner wall which gradually becomes smaller toward the third hole portion and has a taper ratio smaller than that of the first hole portion, and the third hole portion is capable of fitting into the first column portion of the connection pin portion.

17. A running assistance device as described in claim 15, further comprising: a sliding member that is provided so as to be movable in one direction relative to the device main body; a lifting mechanism that connects the device main body and the load-receiving member and raises and lowers the load-receiving member relative to the device main body as the sliding member moves; and a linear actuator that moves the sliding member in the one direction relative to the device main body, wherein the load-receiving member is capable of holding the running tool via the mounting member by rising from below the mounting member fixed to the underside of the main body, and is capable of being detached from the mounting member and the running tool by descending.

18. A driving assistance control method for assisting driving of a running implement in a running assistance device comprising: a driving wheel supported on an equipment body to drive the equipment body; a speed acquisition unit that acquires information on the speed and angular velocity of the equipment body; a connection unit that connects to a running implement comprising a main body unit and a plurality of driven wheels supported on the main body unit and receives a load from the running implement; and a driving force acquisition unit that acquires driving force from the driving wheels, the method comprising: a calibration process that calculates a frictional force of the driven wheels based on the driving force in a state in which no external force is applied to the running implement; and a finite state machine control process, the finite state machine control process comprising: driving control that controls the driving wheels to run with a driving force that resists the frictional force; and stopping control that controls the driving force of the driving wheels to zero, the finite state machine control process transitioning from the driving control to the stopping control when a first condition is satisfied in the driving control, and transitioning from the stopping control to the driving control when a second condition is satisfied in the stopping control.

19. The driving assistance control method according to claim 18, wherein the first condition includes the speed of the device body being lower than a predetermined threshold, and the second condition includes the speed of the device body being equal to or higher than a predetermined threshold.

20. A driving assistance control method as claimed in claim 18 or 19, further comprising an estimation process for calculating an estimate of an external force acting on the traveling implement based on the driving force and the frictional force, wherein the estimation process and the finite state machine control process are repeatedly executed, wherein the driving control calculates a driving force that reduces the external force based on the external force and controls the driving wheels to travel with the calculated driving force, and wherein the stop control controls the driving force of the driving wheels to be zero.

21. The driving assistance control method according to claim 18 or 19, wherein the finite state machine control process further includes braking control that uses a braking force calculated by multiplying the speed and the angular velocity by a predetermined viscous resistance coefficient as a driving force and controls the driving wheels to run with the driving force, and wherein the finite state machine control process transitions from the driving control to the braking control when a third condition is satisfied in the driving control, transitions from the braking control to the driving control when a fourth condition is satisfied in the braking control, and transitions from the braking control to the stop control when a fifth condition is satisfied in the braking control.

22. The driving assistance control method according to claim 21, wherein the driving assistance device further includes an acceleration acquisition unit that acquires information on the acceleration of the device body, the third condition includes the acceleration applied to the device body acting in a direction opposite to the driving direction and the acceleration being equal to or greater than a predetermined threshold, the fourth condition includes the acceleration applied to the device body acting in the driving direction and the acceleration being equal to or greater than a predetermined threshold, and the fifth condition includes the speed of the device body being smaller than a predetermined threshold.

Citation Information

Patent Citations

  • Fitting unit of stretcher

    JP2000107230A

  • Method for controlling conveying device with power assist, and conveying device with power assist

    JP2006001426A

  • Operating tables and floor platforms for operating tables

    JP2017536150A

  • Control device for automatic guided vehicle

    JP2022187099A

  • Travel support device and start support method

    JP2023173321A