Control apparatus, control method, and control program for elastic actuator drive mechanism
AssigneePanasonic Corporation
InventorsMayumi Komatsu, Yasunao Okazaki
Life of this patent
Estimating the term…
Abstract
An abnormality determination unit that determines whether or not an output measurement unit is abnormal is provided, and whether or not the output measurement unit is abnormal is determined. When the output measurement unit is abnormal, an elastic actuator is controlled based on a desired internal state decision unit and an internal state error compensation unit. Accordingly, it becomes possible to control the elastic actuator to continuously operate to a predetermined position without instantaneously stopping even when the output measurement unit is abnormal.
Claims20
A control apparatus for an elastic actuator drive mechanism, comprising;
- a desired value output unit that outputs a desired value of an output of an elastic actuator;
- an output error compensation unit that compensates an output error by receiving the desired value of the output of the elastic actuator and a measurement value of the output of the elastic actuator, the measurement value being measured by an output measurement unit;
- a desired internal state decision unit that decides a desired value of the internal state of the elastic actuator with respect to a measurement value of the internal state, based on a relationship between the output and the internal state of the elastic actuator, with reference to the desired value of the output of the elastic actuator, the measurement value being measured by an internal state measurement unit;
- an internal state error compensation unit that compensates an internal state error based on an output from the output error compensation unit and an output from the internal state measurement unit;
- and
- an abnormality determination unit that determines whether or not the output measurement unit is abnormal based on the measurement value of the output of the elastic actuator measured by the output measurement unit, the measurement value of the internal state of the elastic actuator measured by the internal state measurement unit, and the desired value of the output of the elastic actuator, wherein
- when the abnormality determination unit determines that the output measurement unit is abnormal, an operation of the output error compensation unit is stopped, and control is performed so that the elastic actuator continues to operate based on an output desired value as the output of the desired value output unit by the desired internal state decision unit and the internal state error compensation unit.
A control method for an elastic actuator drive mechanism, comprising:
- outputting, by a desired value output unit, a desired value of an output of an elastic actuator;
- compensating, by an output error compensation unit, an output error by receiving the desired value of the output of the elastic actuator and a measurement value of the output of the elastic actuator, the measurement value being measured by an output measurement unit;
- deciding, by a desired internal state decision unit, a desired value of the internal state of the elastic actuator with respect to a measurement value of the internal state measured by an internal state measurement unit, based on a relationship between the output and the internal state of the elastic actuator, with reference to the desired value of the output of the elastic actuator;
- compensating, by an internal state error compensation unit, an internal state error based on an output from the output error compensation unit and an output from the internal state measurement unit;
- and
- determining, by an abnormality determination unit, whether or not the output measurement unit is abnormal based on the measurement value of the output of the elastic actuator measured by the output measurement unit, the measurement value of the internal state of the elastic actuator measured by the internal state measurement unit, and the desired value of the output of the elastic actuator, wherein
- when the abnormality determination unit determines that the output measurement unit is abnormal, an operation of the output error compensation unit is stopped, and control is performed so that the elastic actuator continues to operate based on an output desired value as the output of the desired value output unit by the desired internal state decision unit and the internal state error compensation unit.
A control program for a control apparatus of an elastic actuator drive mechanism, the control program causing a computer to function as:
- a desired value output unit that outputs a desired value of an output of an elastic actuator;
- an output error compensation unit that compensates an output error by receiving the desired value of the output of the elastic actuator and a measurement value of the output of the elastic actuator, the measurement value being measured by an output measurement unit;
- a desired internal state decision unit that decides a desired value of the internal state of the elastic actuator with respect to a measurement value of the internal state, based on a relationship between the output and the internal state of the elastic actuator, with reference to the desired value of the output of the elastic actuator, the measurement value being measured by an internal state measurement unit;
- an internal state error compensation unit that compensates an internal state error based on an output from the output error compensation unit and an output from the internal state measurement unit;
- and
- an abnormality determination unit that determines whether or not the output measurement unit is abnormal based on the measurement value of the output of the elastic actuator measured by the output measurement unit, the measurement value of the internal state of the elastic actuator measured by the internal state measurement unit, and the desired value of the output of the elastic actuator, wherein
- when the abnormality determination unit determines that the output measurement unit is abnormal, an operation of the output error compensation unit is stopped, and control is performed so that the elastic actuator continues to operate based on an output desired value as the output of the desired value output unit by the desired internal state decision unit and the internal state error compensation unit.
Dependencies are inferred from the claim text.