The disclosure of Japanese Patent Application No. 2017-056227 filed on Mar. 22, 2017, Japanese Patent Application No. 2017-173534 filed on Sep. 8, 2017, Japanese Patent Application No. 2017-173532 filed on Sep. 8, 2017, and Japanese Patent Application No. 2017-173533 filed on Sep. 8, 2017, each including the specification, drawings and abstract, is incorporated herein by reference in its entirety.
The disclosure relates to an assist device that assists the motion of an assist target body part of a user.
Japanese Unexamined Patent Application Publication No. 2013-173190 (JP 2013-173190 A), for example, describes a wearable motion assist device that assists the motion of the thighs relative to the waist when a user lifts up a heavy thing by bending and stretching of the waist or when the user walks normally. The wearable motion assist device includes a waist frame configured to be worn on the waist of the user, a back pad, an abdominal pad, connecting members connecting the back pad and the abdominal pad to each other, thigh fixing portions configured to be fixed to the thighs, and drive mechanisms configured to drive the thigh fixing portions relative to the waist frame. The wearable motion assist device further includes biological signal detection sensors that are stuck to the skin of the user, and a control unit configured to control the drive mechanisms based on biological signals output from the biological signal detection sensors. In order to detect biological potential signals such as a muscle potential signal and a neurotransmission signal from the skin, the biological signal detection sensor includes electrodes for detecting a weak potential. The biological signal detection sensors are stuck to the skin of the user, using adhesive seals covering portions around the electrodes, on the front sides of the right and left thighs in the vicinity of the waist, on the inner sides of the right and left thighs in the vicinity of the waist, on the right and left hips, on the right and left sides of the back slightly above the waist, and so on.
In the case of the wearable motion assist device described in JP 2013-173190 A, many biological signal detection sensors are required and should be stuck to many portions of the user, such as on the front sides of the right and left thighs, on the inner sides of the right and left thighs, on the right and left hips, and on the right and left sides of the back. Therefore, when the user wears the assist device for use, it takes much time and effort. Further, before the biological signal detection sensors are stuck, it also takes time and effort to determine sticking positions of the sensors and the number of sensors to be stuck (for example, three sensors are stuck close to each other for one measurement portion). Further, there is a possibility that processing to remove noise from weak biological signals detected by many biological signal detection sensors, and processing to estimate what kind of motion is being performed (lifting up a heavy thing, walking, or the like) based on biological signals from the respective biological signal detection sensors, and to assist the motion become very complicated. Further, when a motion of lifting up a heavy thing and a motion of walking are distinguished from each other, it is necessary to stick biological signal detection sensors around the waist, i.e. muscles to be mainly used when lifting up the heavy thing, and around the thighs, i.e. muscles to be mainly used when walking, and therefore, a large number of biological signal detection sensors are required.
Further, in the case of the wearable motion assist device described in JP 2013-173190 A, when the motion of assist target body parts of the user is slow, for example, when the motion of the user lifting up a heavy thing at the user's feet is assisted, there is a possibility that processing to estimate the kind of motion is delayed to cause a shortage of assist torque. When the heavy thing is lifted up, a large assist torque is required particularly at the start of the lift-up. However, since, in addition to a delay in estimation of the motion, the speed of the lift-up motion of the user itself is slow, there is a possibility that a sufficient assist torque cannot be generated at the start of the lift-up.
The disclosure provides an assist device that can be easily worn by a user, that can assist the motion of an assist target body part with a simpler configuration and by simpler control, and that can prevent a shortage of assist torque by performing appropriate correction. In other words, the disclosure provides an assist device that can be easily worn by a user and that can generate an appropriate assist torque in accordance with a motion of the user with a simpler configuration and by simpler control.
An aspect of the disclosure relates to an assist device including a body wearing unit configured to be worn on a body of a user including a region around an assist target body part of the user; and an actuator unit configured to be attached to the body wearing unit and to the assist target body part so as to assist a motion of the assist target body part. The actuator unit includes an output link configured to pivot about a joint of the assist target body part and to be attached to the assist target body part; an actuator including an output shaft configured to generate an assist torque for assisting pivoting of the assist target body part via the output link; a torque determination unit configured to determine a combined torque obtained by combining a user torque and the assist torque from the output shaft, the user torque being input from the output link when the user causes the assist target body part to pivot with force of the user; a correction unit configured to calculate a correction amount for the determined combined torque; and a pivot angle control unit configured to control a pivot angle of the output shaft based on the combined torque determined by the torque determination unit and the correction amount calculated by the correction unit.
According to the above-described aspect, the assist device can be worn only by attaching the body wearing unit and the output link of the actuator unit to the body of the user, and no biological signal detection sensor is required. Therefore, the user can easily wear the assist device. The actuator unit is simply configured by the output link, the actuator, the torque determination unit, the correction unit, and the pivot angle control unit. Since the correction amount for the combined torque is calculated, it is possible to prevent a shortage of the assist torque by performing appropriate correction.
In the above-described aspect, the correction unit may be configured to calculate, based on the combined torque, a posture angle that is an inclination angle of an upper half of the body of the user with respect to a vertical direction, the correction unit configured to calculate the correction amount based on the calculated posture angle.
In the above-described configuration, an appropriate correction amount can be calculated by calculating the correction amount based on the posture angle of the user.
In the above-described aspect, when the posture angle is θL, the correction unit may be configured to calculate, as the correction amount, K sin θL using K that is a constant set in advance.
In the above-described configuration, a specific correction amount can be calculated more easily.
In the above-described aspect, the correction unit may be configured to calculate the correction amount based on a differential value of the combined torque.
In the above-described configuration, an appropriate correction amount can be calculated by calculating the correction amount based on the differential value of the combined torque.
In the above-described aspect, the actuator unit may include a communication unit; the communication unit may be configured to transmit, to an analysis system provided separately from the assist device, user information that is information about the user including the user torque, and assist information that is information about input and output of the actuator unit including the assist torque, the communication unit being configured to receive, from the analysis system, analysis information including a result of analysis performed by the analysis system; and the actuator unit may be configured to adjust an operation of the actuator unit based on the analysis information received from the analysis system.
In the above-described configuration, the analysis system is provided separately from the assist device, and the operation and so on of the assist device are analyzed by the analysis system using the user information and the assist information from the assist device. Then, the assist device adjusts its own operation (i.e., the operation of the assist device) based on the analysis information from the analysis system. Therefore, it is not necessary to install advanced analysis programs or the like on the assist device, and thus, for example, optimal setting unique to the user can be performed relatively easily.
In the above-described aspect, the actuator unit further may include a torque detection unit configured to output a torque-related signal about the combined torque; the torque determination unit may be configured to determine related torque information including the combined torque and the user torque based on the torque-related signal from the torque detection unit; the actuator unit may further include a motion kind determination unit configured to determine a kind of motion of the user based on the determined related torque information, and an assist torque calculation unit configured to calculate the assist torque based on the determined related torque information; the correction unit may be configured to correct the calculated assist torque, based on the determined kind of motion; and the pivot angle control unit may be configured to control the pivot angle of the output shaft based on the assist torque corrected by the correction unit.
In the above-described configuration, the assist device can be worn only by attaching the body wearing unit and the output link of the actuator unit to the body of the user, and no biological signal detection sensor is required. Therefore, the user can easily wear the assist device. The actuator unit is simply configured by the output link, the actuator, the torque detection unit, the torque determination unit, the motion kind determination unit, the correction unit, and the pivot angle control unit. Since the assist torque is corrected based on the determined kind of motion, an appropriate assist torque in accordance with a motion of the user can be generated.
In the above-described aspect, the kind of motion may include a lift-up motion that is a motion in which the user lifts up an object; and when the determined kind of motion is the lift-up motion, the correction unit may be configured to perform at least one of i) assist torque amount correction for correcting magnitude of the assist torque during a lift-up period of time that is a period of time from a time point at which the user starts lift-up of the object to a time point at which the user completes the lift-up of the object, and ii) assist torque phase correction for estimating a user torque peak time point that is a time point at which a maximum user torque is generated, and for performing correction such that an assist torque peak time point that is a time point at which a maximum assist torque is generated becomes earlier than the user torque peak time point, the maximum user torque being a maximum value of the user torque during the lift-up period of time, and the maximum assist torque being a maximum value of the assist torque.
In the above-described configuration, when the kind of motion is the lift-up motion, an appropriate assist torque in accordance with the motion of the user can be generated by performing at least one of the assist torque amount correction and the assist torque phase correction.
In the above-described aspect, the kind of motion may include a motion of work in which the user has an object; the actuator unit may further include an object presence/absence determination unit configured to determine presence or absence of the object in the motion of the work in which the user has the object; and the correction unit may be configured to correct the assist torque in accordance with the presence or absence of the object determined by the object presence/absence determination unit.
In the above-described configuration, when the user does not actually have an object although the motion of the user is the same as the motion of work in which the user has an object, it is possible to prevent the user from being surprised, by suppressing generation of an unnecessarily large assist torque. Thus, it is possible to assist the motion of the user more appropriately.
In the above-described aspect, the kind of motion that is determined by the motion kind determination unit may include an object lift-up/lift-down motion in which the user lifts up an object or the user lowers the object held by the user.
In the above-described configuration, since the kind of motion that is determined includes the object lift-up/lift-down motion, when the user performs lift-up/lift-down of an object in a workplace or the like, it is possible to appropriately assist the work of the user.
In the above-described aspect, the kind of motion that is determined by the motion kind determination unit may further include a moving object laterally motion in which the user moves the object from right to left or from left to right.
In the above-described configuration, the kind of motion that is determined further includes the moving object laterally motion. Appropriate assistance differs depending on the work (the kind of motion). Therefore, by determining whether the motion of the user is the object lift-up/lift-down motion or the moving object laterally motion in a workplace or the like, appropriate assistance can be provided in accordance with the work.
In the above-described aspect, the kind of motion that is determined by the motion kind determination unit may further include a walking motion in which the user walks; the actuator unit may further include a compensation torque calculation unit configured to calculate, based on the torque-related signal from the torque detection unit, a friction compensation torque that is generated for cancelling a friction torque in the actuator unit; and the pivot angle control unit may be configured to control the pivot angle of the output shaft based on a summed assist torque obtained by adding the friction compensation torque calculated by the compensation torque calculation unit to the assist torque corrected by the correction unit.
In the above-described configuration, the friction torque in the actuator unit can be cancelled by the friction compensation torque that is calculated based on the torque-related signal from the torque detection unit. Consequently, not only when object lift-up/lift-down is performed in a workplace or the like, but also during walking such as rehabilitation of walking, difficulty in walking and so on can be reduced by reducing resistance due to the friction torque of the actuator unit, and thus, assist feeling can be improved.
In the above-described aspect, the compensation torque calculation unit may include a torque change amount calculation unit configured to calculate a torque change amount of the user torque based on the torque-related signal, and a dead zone torque determination unit configured to determine whether an absolute value of the torque change amount of the user torque calculated by the torque change amount calculation unit is less than a predetermined dead zone torque value; the compensation torque calculation unit may be configured to calculate the friction compensation torque based on the torque change amount of the user torque calculated by the torque change amount calculation unit; and the compensation torque calculation unit may be configured to set the friction compensation torque to zero when the dead zone torque determination unit determines that the absolute value of the torque change amount of the user torque is less than the predetermined dead zone torque value.
In the above-described configuration, since the friction compensation torque is calculated based on the torque change amount of the user torque, it is possible to reduce the pivot resistance of the output link that is attached to the body part of the user, the pivot resistance being caused due to the friction torque of the actuator unit. Thus, difficulty in walking and so on can be reduced, and accordingly, assist feeling can be further improved. The friction compensation torque is set to zero when it is determined that the absolute value of the torque change amount of the user torque is less than the predetermined dead zone torque value. Consequently, a predetermined dead zone range can be provided in a range where the absolute value of the torque change amount of the user torque is less than the predetermined dead zone torque value, i.e. in a range in the vicinity of a point where the torque change amount of the user torque becomes zero. Thus, vibration of the actuator unit can be suppressed, and thus, assist feeling can be further improved.
The assist device according to above-described aspect may further include an operation unit provided separately from the body wearing unit and the actuator unit and configured to adjust and display an assist control state of the actuator unit.
In the above-described configuration, since the assist control state can be adjusted using the separate operation unit, the user can easily perform adjustment for obtaining a desired assist state. Further, since the assist control state is displayed on the separate operation unit, the user can easily recognize the current assist control state, and thus, the user can easily perform further adjustment on the recognized assist control state.
In the above-described aspect, the operation unit may include a gain operating portion configured to adjust magnitude of the assist torque.
In the above-described configuration, the user can adjust the magnitude of the assist torque (one of the assist control states) using the gain operating portion, and thus, the gain operation is useful. Since the user wearing the assist device can adjust the magnitude of the assist torque, assist feeling can be further improved.
Features, advantages, and technical and industrial significance of exemplary embodiments of the disclosure will be described below with reference to the accompanying drawings, in which like numerals denote like elements, and wherein:
Hereinbelow, the overall structure of an assist device 1 according to a first embodiment will be described with reference to
The overall structure of the assist device 1 will be described with reference to
Referring to
The waist wearing portion 10 includes a right waist wearing portion 11R to be worn around the waist of the right half of the body of the user, and a left waist wearing portion 11L to be worn around the waist of the left half of the body of the user. The waist wearing portion 10 includes a waist applying portion 12D including three layers, i.e. a waist pad portion 12A with a predetermined thickness to be wound around the waist of the user, a waist cloth portion 12B disposed around an outer periphery of the waist pad portion 12A, and each of waist base portions 12C with a predetermined thickness and disposed around an outer periphery of the waist cloth portion 12B. The waist pad portion 12A is formed by, for example, an elastic member, while the waist base portions 12C are made of, for example, a resin. In order to facilitate attaching to and detaching from the user, the right waist wearing portion 11R and the left waist wearing portion 11L respectively include a buckle 13RB provided on a length-adjustable belt 13R and a buckle 13LB provided on a length-adjustable belt 13L.
In the waist wearing portion 10, a virtual pivot axis 15Y is set so as to extend in the right-left direction of the user at hip joints of the user when the waist wearing portion 10 is worn by the user. At a crossing position between the virtual pivot axis 15Y and the right waist wearing portion 11R, a pivot shaft portion 15R projecting rightward along the virtual pivot axis 15Y is fixed to the waist base portion 12C (see
The upper half body wearing portion 20 includes a right upper half body wearing portion 21R to be worn at any position in the right upper half of the body of the user and a left upper half body wearing portion 21L to be worn at any position in the left upper half of the body of the user. The right upper half body wearing portion 21R includes a right chest wearing portion 26R, a belt 23R and a buckle 23RB, a belt 25R, and a right shoulder belt 24R. Likewise, the left upper half body wearing portion 21L includes a left chest wearing portion 26L, a belt 23L and a buckle 23LB, a belt 25L, and a left shoulder belt 24L. The right shoulder belt 24R, the left shoulder belt 24L, and the belts 23R, 23L, 25R, 25L are adjustable in length, while the buckles 23RB, 23LB facilitate attaching and detaching of the upper half body wearing portion 20 to and from the user.
The right chest wearing portion 26R and the left chest wearing portion 26L each include two layers, i.e. a pad portion 22A (e.g. an elastic member) with a predetermined thickness to be worn to cover the chest of the user and a cloth portion 22B disposed around an outer periphery of the pad portion 22A. The rear side of the belt 25R is connected to a rear frame portion 33, the front side of the belt 25R is connected to the rear side of the right chest wearing portion 26R, and the buckle 23RB is connected to the front side of the right chest wearing portion 26R via the belt 23R. Likewise, the rear side of the belt 25L is connected to the rear frame portion 33, the front side of the belt 25L is connected to the rear side of the left chest wearing portion 26L, and the buckle 23LB is connected to the front side of the left chest wearing portion 26L via the belt 23L. In this way, a chest wearing portion (the right chest wearing portion 26R and the left chest wearing portion 26L) extending from the right armpit of the user to the left armpit of the user via the chest of the user is formed by the path including the belt 25R, the right chest wearing portion 26R, the belt 23R (the buckle 23RB), the belt 23L (the buckle 23LB), the left chest wearing portion 26L, and the belt 25L.
The front side of the right shoulder belt 24R is connected to the front upper side of the right chest wearing portion 26R and the rear side of the right shoulder belt 24R is connected to the rear frame portion 33. In this way, when the assist device 1 is worn by the user, the right shoulder belt 24R extends from the front side (front right side) of the upper half of the body of the user, then on the shoulder (right shoulder) of the user, to reach the back side of the user. Likewise, the front side of the left shoulder belt 24L is connected to the front upper side of the left chest wearing portion 26L and the rear side of the left shoulder belt 24L is connected to the rear frame portion 33. In this way, when the assist device 1 is worn by the user, the left shoulder belt 24L extends from the front side (front left side) of the upper half of the body of the user, then on the shoulder (left shoulder) of the user, to reach the back side of the user. The rear side of the right shoulder belt 24R may be connected to the left side of the rear frame portion 33, while the rear side of the left shoulder belt 24L may be connected to the right side of the rear frame portion 33 such that the right shoulder belt 24R and the left shoulder belt 24L cross each other on the back side of the user.
The frame portion 30 includes a right-left link frame portion 32, boxes 32RB, 32LB, pivotal portions 32R, 32L, pads 32RP, 32LP, a box 31, the rear frame portion 33, and so on. The right-left link frame portion 32 links to each other the crossing position between the virtual pivot axis 15Y and the right waist wearing portion 11R (i.e. the pivot shaft portion 15R) and the crossing position between the virtual pivot axis 15Y and the left waist wearing portion 11L (i.e. the pivot shaft portion 15L). As shown in
The pivotal portion 32R and the pad 32RP are attached to the pivot shaft portion 15R so as to be pivotable about the virtual pivot axis 15Y (see
Referring to
As shown in
The torque transmitting portion 50R includes a thigh arm 51R and a thigh wearing portion 52R. As shown in
As shown in
Next, referring to
The actuator base portion 41R is provided with a connecting portion 41RC, a pivot shaft support hole 41RA, a motor support hole 41RM, and so on. The connecting portion 41RC is connected to the holding portion 32RC (see
The speed reducer 42R has a reduction ratio n. Thus, when the first input/output portion 42RA is caused to pivot by a pivot angle θ, the speed reducer 42R causes a second input/output portion 42RB to pivot by a pivot angle nθ. When the second input/output portion 42RB is caused to pivot by a pivot angle nθ, the speed reducer 42R causes the first input/output portion 42RA to pivot by a pivot angle θ. The second input/output portion 42RB of the speed reducer 42R is provided with a groove 42RC, while an inner end portion 43RC of the spiral spring 43R is fitted into the groove 42RC.
The spiral spring 43R stores the assist torque transmitted from the electric motor 45R and the user torque transmitted by the motion of the thigh of the user via the assist arm 57R and the speed reducer 42R, and as a result, the spiral spring 43R stores the combined torque obtained by combining the assist torque and the user torque. Then, the combined torque stored in the spiral spring 43R causes the thigh arm 51R to pivot via the speed reducer 42R and the assist arm 57R. The spiral spring 43R has a spring constant Ks and has a spiral shape with the inner end portion 43RC on the center side and with an outer end portion 43RA on the outer peripheral side. The inner end portion 43RC is fitted into the groove 42RC formed in the second input/output portion 42RB of the speed reducer 42R so as to be supported by the second input/output portion 42RB. A transmission shaft 44RA provided in the driven pulley 44R is fitted into the outer end portion 43RA so that the outer end portion 43RA is supported by the transmission shaft 44RA. The combined torque stored in the spiral spring 43R is calculated based on an angle change amount from a no-load state and the spring constant Ks. For example, the combined torque stored in the spiral spring 43R is calculated based on a pivot angle of the assist arm 57R (obtained by the arm pivot angle detection unit not shown), a rotation angle of the motor shaft of the electric motor 45R (obtained by the encoder not shown), and the spring constant Ks of the spiral spring 43R. Then, the user torque is extracted from the calculated combined torque, and the assist torque corresponding to the user torque is output from the electric motor 45R. Calculation of the angle change amount, calculation of the combined torque, extraction of the user torque, calculation of the assist torque, output of a control signal to the electric motor, and so on are performed by the control device housed in the box 31 (or the box 32RB, 32LB).
The driven pulley 44R is supported so as to be rotatable about the pivot axis 40Y. The transmission shaft 44RA protruding toward the spiral spring 43R is provided near an outer peripheral edge of the driven pulley 44R. The transmission shaft 44RA is fitted into the outer end portion 43RA of the spiral spring 43R so as to move the position of the outer end portion 43RA about the pivot axis 40Y. The driven pulley 44R is rotationally driven by the electric motor 45R via the transmission belt 45RB and the drive pulley 45RA. The driven pulley 44R rotationally driven by the electric motor 45R stores the assist torque in the spiral spring 43R via the transmission shaft 44RA.
The structure (
The pivot mechanism includes the pivot shaft portion 15R and a hole that is provided to extend through the pivotal portion 32R such that the pivot shaft portion 15R is fitted in the hole. The pivot shaft portion 15R is provided (fixed) at the position, where the virtual pivot axis 15Y crosses the waist base portion 12C of the right waist wearing portion 11R, so as to protrude outward from the right waist wearing portion 11R along the virtual pivot axis 15Y. The pivot shaft portion 15R is fitted into the hole in the lower part of the pivotal portion 32R of the frame portion 30 via a bearing 15RB. A coming-off preventing ring 15RC is fitted around a distal end portion, protruding from the bearing 15RB, of the pivot shaft portion 15R. While the pivot shaft portion 15R is fixed to the right waist wearing portion 11R and the hole is provided in the pivotal portion 32R in the description of this embodiment, the pivot shaft portion 15R may be fixed to the pivotal portion 32R and the hole may be provided in the right waist wearing portion 11R. By the pivot mechanism described above, as shown in
Next, the opening angle imparting mechanism configured to cause the actuator unit 4R to pivot in the right-left direction relative to the frame portion 30 will be described. Hereinbelow, while the opening angle imparting mechanism will be described with respect to the actuator unit 4R that is attached to the right side of the waist wearing portion 10, an opening angle imparting mechanism for the actuator unit 4L (see
In
In
The opening angle imparting mechanism may include both the first opening angle imparting mechanism and the second opening angle imparting mechanism or may include only one of them. When the opening angle imparting mechanism includes both the first opening angle imparting mechanism and the second opening angle imparting mechanism, the sum of the first opening angle and the second opening angle is an opening angle.
The pivot axis 40Y of the actuator unit 4R is set to coincide with the virtual pivot axis 15Y when the connecting portion 41RC and the actuator base portion 41R that are supported by the holding portion 32RC are parallel to the pivotal portion 32R (i.e. when the first opening angle is zero) as shown in
Referring to
Input signals from the input portions 32RS, a detection signal from the motor rotation angle detection unit 45RE (a detection signal corresponding to an actual motor shaft angle θa of the electric motor 45R), a detection signal from the output link pivot angle detection unit 57RE (a detection signal corresponding to an actual link angle θL of the assist arm 57R), and so on are input to the control device 61. The control device 61 calculates a rotation angle of the electric motor 45R based on the input signals, and outputs a control signal corresponding to the calculated rotation angle to the motor driver 62. The input portions 32RS include, for example, a power supply switch configured to allow the user to provide instructions regarding the operation and stop of the control device 61, an adjustment dial configured to allow the user to set an assist multiplying factor α (0<α), and an adjustment dial configured to allow the user to set a differential correction gain β (0≤β). The assist multiplying factor α and the differential correction gain p are determined based on an assist torque output and the spring constant Ks, and when a large assist torque is required, a large value (e.g. α>1) is set.
Next, the processing sequence of the control device 61 will be described using a flowchart shown in
Step SB100 is processing for input signals. At step SB100, based on input signals from the input portions 32RS (see
Further, the control device 61 stores an actual link angle θL(t) calculated at the last processing timing, as a last actual link angle θL(t−1) and stores a pivot angle of the output link (the assist arm 57R) detected at the current processing timing, as an actual link angle θL(t). Then, the control device 61 calculates a link angle displacement amount ΔθL as follows and stores it (corresponding to B11 out in
Blocks B10 and B11 show virtual blocks for calculating ΔθL that is output from block B11. A combined torque (t) calculated at the last processing timing is stored as a last combined torque (t−1). A current combined torque (t) that is input from block B43 can be calculated based on the actual motor shaft angle θa(t) of the electric motor 45R, the actual link angle θL(t) of the output link (the assist arm 57R), the spring constant Ks of the spiral spring 43R, the reduction ratio of the speed reducer 42R, the pulley ratio between the drive pulley 45RA and the driven pulley 44R, and so on. Then, the link angle displacement amount ΔθL is calculated based on the calculated current combined torque (t), the last combined torque (t−1), a user torque τH from the user, the actual link angle θL, and so on.
Processing from output B11out of block B11 to block B27 in the control blocks shown in
τa_ref(t)=τa_ref_torq(t)+τa_ref_ang(t) Expression 1
First, processing of calculating the assist torque command value (posture angle variable type τa_ref_ang(t) assist torque be described. The processing of calculating the torque command value (posture angle variable type τa_ref_ang(t) is processing of step SB21 shown in
τa_ref_ang(t)=K*sin θL(t) Expression 2
Next, processing of calculating the assist torque command value (torque variable type) τa_ref_torqW will be described. The processing of calculating the assist torque command value (torque variable type τa_ref_torqW is processing of steps SB22 to SB26 shown in
Δτs=Ks*ΔθL Expression 3
At step SB24, the control device 61 calculates (d/dt) Δτs that is a differential value of the spring torque change amount Δτs. Then, the control device 61 multiplies the spring torque change amount differential value (d/dt) Δτs by the differential correction gain β (determined at step SB100), thereby calculating a required spring torque differential amount β*(d/dt) Δτs that is a differential correction amount.
At step SB26, the control device 61 obtains the sum of τa_ref_torq(t−1) stored at step SB100, α*Δτs calculated at step SB22, and β*(d/dt) Δτs calculated at step SB24, thereby calculating the assist torque command value (torque variable type) τa_ref_torq(t) (see Expression 4).
τa_ref_torq(t)=τa_ref_torq(t−1)+α*Δτs+β*(d/dt)Δτs Expression 4
At step SB27, the control device 61 obtains the sum of τa_ref_ang(t) calculated at step SB21 and τa_ref_torq(t) calculated at step SB26, thereby calculating the total assist torque command value τa_ref(t) (see Expression 5).
τa_ref(t)=τa_ref_torq(t)+τa_ref_ang(t) Expression 5
Next, processing of calculating a motor rotation angle command value θM_ref(t) will be described. The processing of calculating the motor rotation angle command value θM_ref(t) is processing of step SB30 shown in
τa_ref=na*Ks*[na*θL−(θM_ref/nb)] Expression 6
θM_ref=[(na2*Ks*θL−τa_ref)*nb]/(na*Ks) Expression 7
Processing of step SB31 corresponds to blocks B31 and B40 shown in
Torque of block B41 (the electric motor 45R) is input to block B43 as a total assist torque τa via block B42 (the drive pulley 45RA, the transmission belt 45RB, and the driven pulley 44R). The user torque τH, which is torque input from the user itself, is also input to block B43. Block B43 corresponds to the spiral spring 43R. The spiral spring 43R is expanded or contracted in a circumferential direction of the spiral spring 43R by an angle corresponding to a combined torque obtained by combining the total assist torque τa input from the electric motor 45R and the user torque τH input from the user itself, so that the combined torque is stored. The combined torque can be calculated based on the actual motor shaft angle θa(t) of the electric motor 45R, the actual link angle θL(t) of the output link (the assist arm 57R), the spring constant Ks of the spiral spring 43R, the reduction ratio of the speed reducer 42R, and the pulley ratio between the drive pulley 45RA and the driven pulley 44R.
Then, the combined torque stored in block B43 (the spiral spring 43R) is transmitted (output) to the assist target body part (the thigh in this case) from block B50 (the speed reducer 42R and the assist arm 57R). The pivot angle of the assist arm 57R in block B50 becomes the actual link angle θL.
At step SB100 in
The correction unit 61B (the correction unit) shown in
The pivot angle control unit 61C (the pivot angle control unit) shown in
In the assist device 1 described above in this embodiment, for example, when the user bends the knees while taking a forward-bent posture, and lifts up a heavy thing at the user's feet, the (differential) correction amount that is the required spring torque differential amount β*(d/dt) Δτs effectively works when the user stands up slowly. Further, the (posture) correction amount that is the assist torque command value (posture angle variable type) τa_ref_ang effectively works in accordance with a forward-bending angle in the forward-bent posture. Therefore, it is possible to prevent a shortage of the assist torque by performing the appropriate correction.
Since the body wearing unit 2 (see
Various modifications, additions and deletions may be made to the structure, configuration, shape, external appearance, and so on of the assist device of the disclosure within the scope of the disclosure. For example, the processing sequence of the control device is not limited to the flowchart shown in
While the example in which the connection and release of the belts are performed using the buckles has been described for the assist device 1 in this embodiment, the connection and release of the belts may be performed using members different from the buckles. Further, the upper half body wearing portion is not necessarily formed by both the shoulder belts and the chest wearing portions and may be formed by only one of them.
While the example in which the actuator units 4R, 4L are attached to the right and left sides of the body wearing unit has been described for the assist device 1 in this embodiment, the assist device may be configured such that only the actuator unit 4R is attached to the right side of the body wearing unit or the assist device may be configured such that only the actuator unit 4L is attached to the left side of the body wearing unit.
While the example in which the assist multiplying factor α and the differential correction gain β are designated from the input portions 32RS has been described for the assist device 1 in this embodiment, a communication unit 64 (see
Hereinbelow, a second embodiment will be described. The overall structure of an assist device 1 according to the second embodiment is the same as the overall structure of the assist device according to the first embodiment described with reference to
Referring to
Input signals from input portions 32RS, a detection signal from a motor rotation angle detection unit 45RE (a detection signal corresponding to an actual motor shaft angle θrM of the electric motor 45R), a detection signal from an output link pivot angle detection unit 57RE (a detection signal corresponding to an actual link angle θL of an assist arm 57R), and so on are input to the control device 61. The control device 61 calculates a rotation angle of the electric motor 45R based on the input signals and outputs a control signal corresponding to the calculated rotation angle, to the motor driver 62. The input portions 32RS include, for example, a power supply switch configured to allow a user to provide instructions regarding the operation and stop of the control device 61, an adjustment dial configured to allow the user to set an assist multiplying factor α (0<α), and an adjustment dial configured to allow the user to set a differential correction gain β (0≤β). The assist multiplying factor α and the differential correction gain β are determined based on an assist torque output and a spring constant, and when a large assist torque is required, a large value (e.g. α>1) is set.
The motor rotation angle detection unit 45RE, the output link pivot angle detection unit 57RE, and a spiral spring 43R correspond to a torque detection unit that outputs torque-related signals about the combined torque obtained by combining the user torque and the assist torque. A detection signal from the motor rotation angle detection unit 45RE (a detection signal corresponding to a rotation angle of a motor shaft of the electric motor 45R), and a detection signal from the output link pivot angle detection unit 57RE (a detection signal corresponding to a pivot angle of the assist arm 57R) correspond to the torque-related signals.
Control blocks (
At step S100R in
At step S200 in
At step S2A0 in
Steps S300R, S300L, S340R, and S340L in
At step S340R, the control device 61 calculates (right) τss(t) and proceeds to step S340L. The control device 61 calculates (left) τss(t) at step S340L and proceeds to step S710. Details of calculation of (right) τss(t) and calculation of (left) τss(t) will be described later. (Right) τss(t) is for making correction so as to shorten the time until the assist torque of the (right) actuator unit reaches its peak (to advance the phase), while (left) τss(t) is for making correction so as to shorten the time until the assist torque of the (left) actuator unit reaches its peak (to advance the phase). The calculation of (right) τss(t), (left) τss(t) corresponds to processing of block B14 in
Steps S400R, S400L, S440R, and S440L in
Steps S500R and S500L in
When the control device 61 proceeds to step S500R, the control device 61 substitutes 1 for (right) γ and stores it, and substitutes (right) τs(t) for (right) τss(t) and stores it. Further, the control device 61 substitutes zero for (right) τa_ref_torq(t), (right) τa_ref_ang(t), and (right) τa_ref(t) and stores them, and proceeds to step S500L. At step S500L, the control device 61 substitutes 1 for (left) γ and stores it, and substitutes (left) τs(t) for (left) τss(t) and stores it. Further, the control device 61 substitutes zero for (left) τa_ref_torq(t), (left) τa_ref_ang(t), and (left) τa_ref(t) and stores them, and proceeds to step S740.
At step S710 in
(right)τa_ref_torq(t)=(right)τa_ref_torq(t−1)+(right)γ*α*(right)τss(t)+β*(right)Δτss(t) Expression 1
(left)τa_ref_torq(t)=(left)τa_ref_torq(t−1)+(left)γ*α*(left)τss(t)+β*(left)Δτss(t) Expression 2
(right) τa_ref_torq(t): (right) assist torque command value (torque variable type)
(left) τa_ref_torq(t): (left) assist torque command value (torque variable type)
(right) γ: (right) torque correction gain
(left) γ: (left) torque correction gain
α: (right/left) assist multiplying factor
β: (right/left) differential correction gain
(right) τss(t): (right) torque change amount (after phase correction)
(left) τss(t): (left) torque change amount (after phase correction)
At step S720 in
(right)τa_ref_ang(t)=K*sin(right)θL(t) Expression 3
(left)τa_ref_ang(t)=K*sin(left)θL(t) Expression 4
(right) τa_ref_ang(t): (right) assist torque command value (posture angle variable type)
(left) τa_ref_ang(t): (left) assist torque command value (posture angle variable type)
K: (right/left) posture correction gain
(right) θL(t): (right) actual link angle
(left) θL(t): (left) actual link angle
At step S730 in
(right)τa_ref(t)=(right)τa_ref_torq(t)+(right)τa_ref_ang(t) Expression 5
(left)a_ref(t)=(left)τa_ref_torq(t)+(left)τa_ref_ang(t) Expression 6
(right) τa_ref(t): (right) total assist torque command value
(left) τa_ref(t) (left) total assist torque command value
The control device 61 performing the processing from steps S2A0 and S2B0 to step S730 described above functions as an assist torque calculation unit (the assist torque calculation unit 161C shown in
At step S740 in
(right)τa_ref(t)=na*Ks*[na*(right)θL(t)−((right)θM(t)/nb)] Expression 7
(right)θM(t)=[(na2*Ks*(right)θL(t)−(right)τa_ref(t)*nb]/(na*Ks) Expression 8
(left)τa_ref(t)=na*Ks*[na*(left)θL(t)−((left)θM(t)/nb)] Expression 9
(left)θM(t)=[(na2*Ks*(left)θL(t)−(left)τa_ref(t))*nb]/(na*Ks) Expression 10
Ks: spring constant of the spiral spring 43R
(right) θM(t): (right) motor rotation angle command value
(left) θM(t): (left) motor rotation angle command value
na and nb: when a first input/output portion 42RA of a speed reducer 42R is rotated by na, a second input/output portion 42RB of the speed reducer 42R is rotated by nb.
At step S750 in
Further, the control device 61 stores a (right) assist torque command value (torque variable type) τa_ref_torq(t) calculated at the last processing timing, as a last (right) assist torque command value (torque variable type) τa_ref_torq(t−1). Further, the control device 61 stores a (right) motor shaft angle detected at the current processing timing, as a (right) actual motor shaft angle θrM(t).
Further, the control device 61 stores a (right) actual link angle θL(t), calculated at the last processing timing, as a last (right) actual link angle θL(t−1) and stores a pivot angle of the output link (the assist arm 57R) detected at the current processing timing, as a (right) actual link angle θL(t). Then, the control device 61 calculates a (right) link angle displacement amount ΔθL(t) using Expression 11 described below and stores it.
(right)ΔθL(t)=(right)θL(t)−(right)θL(t−1) Expression 11
(right)θL(t): (right) actual link angle
(right)ΔθL(t): (right) link angle displacement amount
Further, the control device 61 stores a (right) combined torque (t) calculated at the last processing timing, as a last (right) combined torque (t−1), calculates a current (right) combined torque (t) using Expression 12 provided below with the use of the spring constant Ks of the spiral spring 43R (see
(right)combined torque(t)=Ks*(expanded/contracted amount of the spiral spring 43R) Expression 12
Further, the control device 61 stores a (right) torque change amount τs(t) calculated at the last processing timing, as a last (right) torque change amount τs(t−1), calculates a current (right) torque change amount τs(t) using Expression 13 described below, and stores it.
(right)τs(t)=Ks*(right)ΔθL(t) Expression 13
(right)τs(t): (right) torque change amount
Step S100L (see
Step S200 (see
At step S210 (see
When the control device 61 proceeds to step S215, the control device 61 determines whether (right) combined torque (t)*(left) combined torque (t) is greater than or equal to a preset second torque threshold value τ2. When it is greater than or equal to the second torque threshold value τ2 (Yes), the control device 61 determines that the motion of the user is “object lift-up/lift-down”, and proceeds to step S230B, while when it is not greater than or equal to (i.e., it is less than) the second torque threshold value τ2 (No), the control device 61 proceeds to step S220.
When the control device 61 proceeds to step S220, the control device 61 determines whether [(right) θL(t)+(left) θL(t)]/2 is greater than the preset first angle threshold value θ1, and further, (right) combined torque (t)*(left) combined torque (t) is less than the preset first torque threshold value τ1. If affirmative (Yes), the control device 61 determines that the motion of the user is “moving object laterally”, and proceeds to step S230C, while if negative (No), the control device 61 ends the processing.
When the control device 61 proceeds to step S230A, the control device 61 stores “walking” as the kind of motion and ends the processing. When the control device 61 proceeds to step S230B, the control device 61 stores “object lift-up/lift-down” as the kind of motion and ends the processing. When the control device 61 proceeds to step S230C, the control device 61 stores “moving object laterally” as the kind of motion and ends the processing.
Step S300R (see
At step S314R (see
[LIFT-UP REFERENCE MOTION] shown in
When the control device 61 proceeds to step S316R, the control device 61 determines whether (right) τs(t−1) is less than zero, and further, (right) τs(t) is greater than or equal to zero. This determination determines whether a current point of time is Q2 at which the assist torque changes from negative to positive in
When the control device 61 proceeds to step S320R (in the case of the position of Q1 in
(right)Δτs(t)=(right)τs(t)−(right)τs(t−1) Expression 14
At step S322R, the control device 61 calculates a (right) torque correction gain γ using Expression 15 described below and stores it, and ends the processing. A (right) torque correction gain γ may be calculated using Expression 16 described below, and stored. In Expression 15, (right) Δτs,max is an inclination, at the position of Q1, of a graph of τs(t) corresponding to [LIFT-UP REFERENCE MOTION] shown in
(right)γ=√((right)Δτs,max/(right)Δτs) Expression 15
(right)γ=√[((d/dt)(right)ΔθL,max)/((d/dt)(right)ΔθL)] Expression 16
(Right) γ is a gain for making correction such that, in [CASE IN WHICH CYCLE IS LONG AND ASSIST TORQUE BEFORE CORRECTION IS SMALL AS COMPARED TO LIFT-UP REFERENCE MOTION] shown in
When the control device 61 proceeds to step S324R (in the case of the position of Q2 in
Using (right) γ calculated by the sequence described above, assist torque amount correction for correcting the magnitude of the assist torque is performed from time tb1 to time tb2, i.e. during a lift-up period of time from the start of lift-up until the completion of lift-up, in [CASE IN WHICH CYCLE IS LONG AND ASSIST TORQUE BEFORE CORRECTION IS SMALL AS COMPARED TO LIFT-UP REFERENCE MOTION] shown in
Step S340R (see
At step S344R (see
At step S346R, the control device 61 determines whether (right) τs(t−1) is greater than or equal to zero, and further, (right) τs(t) is less than zero (negative). This determination determines whether a current point of time is Q1 at which the assist torque changes from positive to negative in
When the control device 61 proceeds to step S348R, the control device 61 substitutes 1 for a (right) operation state flag and stores it, and proceeds to step S350R.
When the control device 61 proceeds to step S350R, the control device 61 determines whether the (right) operation state flag is 1, and further, (right) τss(t) is less than zero (negative). This determination determines whether a current point of time is in a “lift-up period of time” in which the assist torque is in a negative state in
[LIFT-UP REFERENCE MOTION] shown in
When the control device 61 proceeds to step S352R (in the case of a period of time from the position of Q2 to the position of Q1 in
When the control device 61 proceeds to step S360R (in the case of a lift-up period of time from the position of Q1 to the position of Q2 in
(right)T=(right)γ*Tbase Expression 17
(right) T: estimated time ((right) convergence time) from when the user actually starts lift-up of an object until the completion of lift-up of the object
Tbase: time from the start of lift-up of an object until the completion of lift-up of the object in the reference motion (=lift-up period of time in the reference motion)
At step S362R, the control device 61 calculates (estimates) a (right) assist torque peak value P in the lift-up period of time of the user using Expression 18 described below and stores it, and proceeds to step S364R. Pbase is a maximum value of the magnitude of the assist torque in “LIFT-UP PERIOD OF TIME” shown in [LIFT-UP REFERENCE MOTION] of
(right)P=Pbase/(right)γ Expression 18
(right) P: maximum value (estimated maximum value) of the assist torque in an actual lift-up period of time of the user
Pbase: maximum value of the assist torque in a lift-up period of time in the reference motion
At step S364R, the control device 61 determines whether a (right) elapsed time t from when the (right) operation state flag is set to 1 from 0 is shorter than a value (γT1) obtained by multiplying a preset peak reaching reference time T1 by (right) γ. If affirmative (Yes), the control device 61 proceeds to step S366R, while if negative (No), the control device 61 proceeds to step S368R. The peak reaching reference time T1 is a time that is determined by various experiments and so on. As a result of various experiments, the inventors have found that when the user starts lift-up of an object, it is effective to adjust the position of a peak value of the assist torque in accordance with the length of a lift-up motion time (the slowness of a lift-up motion). The peak reaching reference time T1 is set as an optimal time from the start of a lift-up motion until the assist torque reaches its peak in the reference motion.
When the control device 61 proceeds to step S366R, the control device 61 calculates (right) τss(t) using Expression 19 described below and stores it, and proceeds to step S370R.
(right)τss(t)=−(right)P*sin [2*(right)T*π*(right)t/(γ*T1)] Expression 19
(right) t: elapsed time from when the (right) operation state flag is set to 1 from 0
T1: peak reaching reference time
When the control device 61 proceeds to step S368R, the control device 61 calculates (right) τss(t) using Expression 20 described below and stores it, and proceeds to step S370R.
(right)τss(t)=−(right)P*sin {[2*(right)T*π*((right)t−γ*T1)]/[(right)T−γ*T1]+π/2} Expression 20
When the control device 61 proceeds to step S370R, the control device 61 calculates (right) Δτss(t) using Expression 21 described below and stores it, and ends the processing.
(right)Δτss(t)=(right)τss(t)−(right)τss(t−1) Expression 21
Using (right) τss(t) calculated by the sequence described above, assist torque phase correction for correcting the position of the peak of the assist torque in a lift-up period of time so as to move the position of the peak to a position after the lapse of γT1 from the start of lift-up is performed in [CASE IN WHICH CYCLE IS LONG AND ASSIST TORQUE BEFORE CORRECTION IS SMALL AS COMPARED TO LIFT-UP REFERENCE MOTION] shown in
As described above, the assist device 1 according to this embodiment can generate an assist torque that is appropriately corrected in accordance with the motion of the user (“walking”, “object lift-up/lift-down”, or “moving object laterally”). For example, when the motion of the user is slow in “object lift-up”, the assist torque can be appropriately increased with the use of a torque correction gain γ. Further, for example, when the motion of the user is slow in “object lift-up”, the position of the peak of the assist torque can be set to an appropriate timing by shortening the time to the peak of the assist torque using τss(t).
Since the body wearing unit 2 (see
In the description of this embodiment, the kinds of motions to be determined are three kinds, i.e. “walking”, “object lift-up/lift-down”, and “moving object laterally”. However, determination on work that includes “object lift-up/lift-down” and does not include “walking” may be performed. Alternatively, determination on work that includes “object lift-up/lift-down” and “moving object laterally”, and does not include “walking” may be performed.
Referring to
Referring to
As shown in
The main operating portion R1A is a switch configured to start and stop assist control that is performed by the assist device 1A. As shown in
Each of the gain UP operating portion R1BU and the gain DOWN operating portion R1BD is a switch configured to adjust the above-described assist multiplying factor α and differential correction gain β stepwise such that assist force is increased or assist force is reduced, in accordance with an operation performed by the user.
Therefore, when the operation unit R1 is added, the input portions 32RS shown in
Each of the timing UP operating portion R1CU and the timing DOWN operating portion R1CD is a switch configured to adjust the above-described peak reaching reference time T1 (see
The control device R1E of the operation unit R1 transmits operation information via the communication unit R1EA (see
In response to receipt of the operation information, the control device 61 in the box 31 stores the received operation information and transmits via the communication unit 64 (see
The control device 61 (see
Further, for example, as shown in “CONTROL DEVICE ASSIST TIMING” of
The above-described “the assist multiplying factor α and the differential correction gain β corresponding to the gain number included in the operation information” and “the peak reaching reference time T1 corresponding to the timing number included in the operation information” are determined and stored at step S100R in a flowchart of
As described above, by operating the operation unit R1, the user can easily perform adjustment for a desired assist state. Further, since the battery remaining amount, error information, and so on are displayed in the display portion IUD of the operation unit R1, the user can easily grasp the state of the assist device 1A. Forms of various information displayed in the display portion IUD are not limited to those shown in
Hereinbelow, a description will be provided on an example in which the user that will perform work such as object lift-up/lift-down or moving object laterally in a warehouse or the like wears the assist device 1A (see
Before wearing the assist device 1A, the user operates the main power supply switch 65 to the ON-side so as to start the control device 61 and the control device R1E (see
The user wearing the assist device 1A operates the main operating portion R1A (see
When the user desires an increase or decrease in assist torque while performing the work of object lift-up/lift-down or the work of moving object laterally, the user can easily perform adjustment to obtain a desired assist torque by operating the gain UP operating portion R1BU or the gain DOWN operating portion R1BD of the operation unit R1. Further, when the user feels a desire to make a peak timing of the assist torque earlier or later while performing the work of object lift-up/lift-down, the user can easily adjust the peak timing of the assist torque to a desired timing by operating the timing UP operating portion R1CU or the timing DOWN operating portion R1CD of the operation unit R1. For example, when the control device 61 has detected an abnormality of an electric motor 45R, a motor driver, any of various sensors (detection units), or the like during the operation of the assist control, the control device 61 transmits response information including error information so as to display the error information in the display portion RID of the operation unit R1 such that the operation of the assist device 1A is automatically stopped.
During a break time from the work, the user can (temporarily) stop the operation of the assist device 1A by operating the main operating portion R1A (see
When the work has been finished, the user operates the main operating portion R1A (see
Referring to
In view of this, as shown in the flowchart of
After performing the processing of step S200, the control device 61 proceeds to step S280. At step S280, the control device 61 calculates a friction compensation torque τfric(t), and proceeds to step S2A0. The control device 61 calculates the friction compensation torque τfric(t) at step S280 as follows.
[Region 1]: When τs(t)≤−τs,thre (when the absolute value of τs(t) is greater than or equal to a torque threshold value), τfric(t)=−τfric,min (−τfric,min: lower limit friction compensation torque). [Region 2]: When −τs,thre≤−τs,dead, τfric(t)=−τfric,min*[(−τs,dead)−τs(t)]/[(−τs,dead)−(−τs,thre)]. [Region 3]: When −τs,dead<τs(t)<τs,dead (when the absolute value of τs(t) is less than a dead zone torque value), τfric(t)=0. [Region 4]: When τs,dead≤τs(t)<τs,thre, τfric(t)=τfric,max*[τs(t)−(τs,dead)]/[(τs,thre)−(τs,dead)]. [Region 5]: When τs,thre≤τs(t) (when the absolute value of τs(t) is greater than or equal to a torque threshold value), τfric(t)=τfric,max(τfric,max: upper limit friction compensation torque). In the case of [Region 2] or [Region 4], the magnitude of friction compensation torque τfric(t) is not necessarily set to increase linearly, and may be set to increase curvedly.
The control device 61 performing the processing of step S280 functions as a compensation torque calculation unit (a compensation torque calculation unit 61F shown in
After performing the processing of step S500L, the control device 61 proceeds to step S510. At step S510, the control device 61 sets a value obtained by adding the friction compensation torque τfric(t) to the (right) total assist torque command value τa_ref(t)(=0) set at step S500R, as a new (right) total assist torque command value (summed assist torque) τa_ref(t). Further, the control device 61 sets a value obtained by adding the friction compensation torque τfric(t) to the (left) total assist torque command value τa_ref(t)(=0) set at step S500L, as a new (left) total assist torque command value (summed assist torque) τa_ref(t). The processing of step S510 corresponds to node N41 in
After performing the processing of step S730, the control device 61 proceeds to step S731. At step S731, the control device 61 sets a value obtained by adding the friction compensation torque τfric(t) to the (right) total assist torque command value τa_ref(t) calculated at step S730, as a new (right) total assist torque command value (summed assist torque) τa_ref(t). Further, the control device 61 sets a value obtained by adding the friction compensation torque τfric(t) to the (left) total assist torque command value τa_ref(t) calculated at step S730, as a new (left) total assist torque command value (summed assist torque) τa_ref(t). The processing of step S731 corresponds to node N41 in
As described above, by adding the friction compensation torque τfric(t) to each of the (right) total assist torque command value τa_ref(t) and the (left) total assist torque command value τa_ref(t) at step S510 or S731, the control device 61 can cancel friction torque in each of the actuator units 4R, 4L caused by the speed reducer 42R and so on. Consequently, it is possible to appropriately prevent occurrence of a situation where extra force corresponding to the friction torque is required during walking and assist feeling is lowered due to cancellation of part of assist force by the friction torque during the work such as object lift-up.
When the control device 61 has determined at step S200 that the kind of motion is a walking motion, the control device 61 performs setting at step S510 so that the new (right) total assist torque command value (summed assist torque) τa_ref(t) and the new (left) total assist torque command value (summed assist torque) τa_ref(t) each become only the friction compensation torque τfric(t). Consequently, also during walking such as rehabilitation of walking, for example, difficulty in walking and so on can be reduced by reducing resistance due to friction torque of each of the actuator units 4R, 4L, and thus, assist feeling can be improved.
When it has been determined that the absolute value of the torque change amount τs(t) is less than τs,dead (less than the predetermined dead zone torque value), i.e. the torque change amount τs(t) is in Region 3, the friction compensation torque τfric(t) is set to 0 (zero). Consequently, a predetermined dead zone range can be provided in the vicinity of a point where the torque change amount τs(t) becomes 0 (zero). Thus, vibration of each of the actuator units 4R, 4L can be suppressed, and accordingly, assist feeling is further improved.
When it has been determined that the absolute value of the torque change amount τs(t) is greater than or equal to τs,thre (greater than or equal to the torque threshold value), i.e. the torque change amount τs(t) is in Region 1 or Region 5, the friction compensation torque τfric(t) is set to −τfric,min (lower limit friction compensation torque) or τfric,max (upper limit friction compensation torque). Consequently, by setting the friction compensation torque τfric(t), which reduces friction torque in each of the actuator units 4R, 4L, in a fixed range, an appropriate friction compensation torque τfric(t) in accordance with a motion of the user can be generated, and thus, assist feeling can be further improved.
The control device 61 performing the processing of steps S280 to S731 in the flowchart of
Referring to
As shown in
At step S252 in
When the control device 61 proceeds to step S253, the control device 61 determines whether (right) τs(t−1) is greater than or equal to zero, and further, (right) τs(t) is less than zero. This determination determines whether a current point of time is Q1 at which the assist torque changes from positive to negative in
When the control device 61 proceeds to step S254, the control device 61 sets a (right) object check flag to “ON”, stores a current (right) actual link angle θL as a (right) object check angle, and starts measurement of (right) check time. Then, the control device 61 proceeds to step S255.
At step S255, the control device 61 determines whether the (right) object check flag=1, and further, the (right) check time is greater than or equal to a time T2. If affirmative (Yes), the control device 61 proceeds to step S256, while if negative (No), the control device 61 proceeds to step S257. As shown in
When the control device 61 proceeds to step S256, the control device 61 stores “(right) object check angle−(right) actual link angle θL (after the lapse of time T2)” as (right) ΔC and sets the (right) object check flag to “OFF”. Then, the control device 61 proceeds to step S257. That is, the change amount of the (right) actual link angle during the minute time T2 from the time point of Q1 is stored as (right) ΔC.
At step S257, the control device 61 determines whether (left) τs(t−1) is greater than or equal to zero, and further, (left) τs(t) is less than zero. This determination determines whether a current point of time is Q1 at which the assist torque changes from positive to negative in
When the control device 61 proceeds to step S258, the control device 61 sets a (left) object check flag to “ON”, stores a current (left) actual link angle θL as a (left) object check angle, and starts measurement of (left) check time. Then, the control device 61 proceeds to step S259.
At step S259, the control device 61 determines whether the (left) object check flag=1, and further, the (left) check time is greater than or equal to a time T2. If affirmative (Yes), the control device 61 proceeds to step S260, while if negative (No), the control device 61 proceeds to step S261. As shown in
When the control device 61 proceeds to step S260, the control device 61 stores “(left) object check angle−(left) actual link angle θL (after the lapse of time T2)” as (left) ΔC and sets the (left) object check flag to “OFF”. Then, the control device 61 proceeds to step S261. That is, the change amount of the (left) actual link angle during the minute time T2 from the time point of Q1 is stored as (left) ΔC.
At step S261, the control device 61 determines whether (right) ΔC is less than a threshold value ε, and further, (left) ΔC is less than the threshold value ε. If affirmative (Yes), the control device 61 proceeds to step S262A, while if negative (No), the control device 61 proceeds to step S262B. The threshold value ε is set in advance by various experiments, simulations, and so on. In a case where the user has a heavy object, since the motion of the user after Q1 becomes relatively slow so that the values of (right) ΔC and (left) ΔC become relatively small. In a case where the user does not have an object (including a case where the user has a very light object), since the motion of the user after Q1 becomes relatively fast so that the values of (right) ΔC and (left) ΔC become relatively large.
When the control device 61 proceeds to step S262A, the control device 61 sets the object present flag to “ON” (determining that an object is present) and ends the processing. When the control device 61 proceeds to step S262B, the control device 61 sets the object present flag to “OFF” (determining that an object is absent) and ends the processing. The control device 61 performing the processing of steps S252 to S262B described above functions as an object presence/absence determination unit (an object presence/absence determination unit 61H shown in
As shown in
After performing the processing of step S322R, the control device 61 proceeds to step S326R. At step S326R, the control device 61 determines whether the kind of motion is “object lift-up/lift-down”, and when the kind of motion is “object lift-up/lift-down” (Yes), the control device 61 proceeds to step S327R, while when the kind of motion is not “object lift-up/lift-down” (No), the control device 61 ends the processing.
When the control device 61 proceeds to step S327R, the control device 61 determines whether the object present flag is zero (determining whether an object is absent), and when the object present flag is zero (an object is absent) (Yes), the control device 61 proceeds to step S328R, while when the object present flag is 1 (an object is present) (No), the control device 61 ends the processing.
When the control device 61 proceeds to step S328R, the control device 61 multiplies the (right) torque correction gain γ calculated at step S322R by, for example, 0.5, thereby calculating a new (right) torque correction gain γ, and ends the processing. The multiplication coefficient is not limited to 0.5, and is a value determined by various experiments and simulations and is a value greater than or equal to zero and less than 1. That is, the control device 61 causes the torque correction gain γ (corresponding to the correction amount of assist torque amount correction) when an object is determined to be absent, to be smaller than the torque correction gain γ when an object is determined to be present.
Referring to
The example has been described in which presence or absence of an object is determined (i.e., it is determined whether an object is present) and the assist torque is changed in accordance with the presence or absence of an object (i.e., in accordance with whether an object is present) when the kind of motion is “object lift-up/lift-down”. However, presence or absence of an object may be determined and the assist torque may be changed in accordance with the presence or absence of an object even when the kind of motion is “moving object laterally”. That is, in the motion of work in which the user has an object (including “object lift-up/lift-down” and “moving object laterally”), presence or absence of an object may be determined and the assist torque may be corrected in accordance with the determined presence or absence of an object.
Number | Date | Country | Kind |
---|---|---|---|
2017-056227 | Mar 2017 | JP | national |
2017-105011 | May 2017 | JP | national |
2017-105012 | May 2017 | JP | national |
2017-173532 | Sep 2017 | JP | national |
2017-173533 | Sep 2017 | JP | national |
2017-173534 | Sep 2017 | JP | national |