Sensor apparatus and robot apparatus
To well remove a noise component due to vibration of a flexible member from an original detection signal output from a detecting unit and suppress a phase delay of a detection signal obtained by filtering. For this purpose, the present invention provides a detecting unit including a flexible member deforming according to a state of an object to be measured and a sensor detecting an amount of deformation of the flexible member and outputting an original detection signal indicating a detection result. A filtering unit outputs a detection signal obtained by filtering the original detection signal using a filter coefficient. A calculating device calculates a vibration frequency of the flexible member contained in the original detection signal. A changing unit changes a filter coefficient of the filtering unit to cause the filtering unit to function as a filter for attenuating the vibration frequency calculated by the calculating device.
1. A sensor apparatus comprising:
a detecting unit including a flexible member deforming according to a state of an object to be measured and a sensor detecting an amount of deformation of the flexible member and outputting an original detection signal indicating a detection result;
a digital filter outputting a detection signal obtained by filtering the original detection signal using a filter coefficient;
a calculation unit calculating a vibration frequency of the flexible member contained in the original detection signal; and
a change unit changing the filter coefficient of the digital filter to cause the digital filter to function as a filter for attenuating the vibration frequency calculated by the calculation unit.
2. The sensor apparatus according to claim 1 , wherein the detecting unit is a force sensor.
3. The sensor apparatus according to claim 2 , wherein the calculation unit has a storage unit storing a relational expression or a table indicating a correlation between a force or a torque acting on the object to be measured and the vibration frequency, the detection signal is input into the calculation unit and the calculation unit calculates the vibration frequency using the relational expression or the table.
4. The sensor apparatus according to claim 1 , wherein the detecting unit is a torque sensor.
5. The sensor apparatus according to claim 4 , wherein the calculation unit has a storage unit storing a relational expression or a table indicating a correlation between a torque acting on the object to be measured and the vibration frequency, the detection signal is input into the calculation unit and the calculation unit calculates the vibration frequency using the relational expression or the table.
6. The sensor apparatus according to claim 1 , wherein the original detection signal is input into the calculation unit, the calculation unit performs a fast Fourier transformation to convert the original detection signal from a time domain signal to a frequency domain signal, and extracts a frequency component that is a frequency exceeding a frequency band of a signal component contained in the original detection signal and is a peak value from a calculation result as the vibration frequency.
7. The sensor apparatus according to claim 1 , further comprising:
sending means connected to the calculation unit; and
receiving means connected to the change unit and receiving a signal indicating the vibration frequency from the sending means.
8. A sensor apparatus comprising:
a detecting unit including a flexible member deforming according to a state of an object to be measured and a sensor detecting an amount of deformation of the flexible member and outputting an original detection signal indicating a detection result;
a digital filter having a plurality of filtering units for filtering using a filter coefficient and outputting a detection signal obtained by filtering the original detection signal by the plurality of filtering units;
a calculation unit calculating each of a plurality of vibration frequencies of the flexible member contained in the original detection signal; and
a change unit changing the filter coefficient of each of the filtering units to cause the digital filter to function as a filter for attenuating each of the vibration frequencies calculated by the calculation unit.
9. A robot apparatus comprising:
a robot arm body having a plurality of links coupled through a joint portion, and a hand disposed in a distal link arranged in a distal portion of the plurality of links and gripping an object to be gripped;
a plurality of actuators driving the plurality of links and the hand;
a force sensor including a flexible member deforming according to a force or a torque acting on the hand, and a sensor detecting an amount of deformation of the flexible member and outputting an original detection signal indicating a detection result;
a digital filter outputting a detection signal obtained by filtering the original detection signal using a filter coefficient;
a calculation unit calculating a vibration frequency of the flexible member contained in the original detection signal;
a change unit changing the filter coefficient of the digital filter to cause the digital filter to function as a filter for attenuating the vibration frequency calculated by the calculation unit; and
a control unit controlling the actuator using the detection signal output from the digital filter.
10. The robot apparatus according to claim 9 , wherein the original detection signal is input into the calculation unit, the calculation unit performs a fast Fourier transformation to convert the original detection signal from a time domain signal to a frequency domain signal, and extracts a frequency component that is a frequency exceeding the frequency band of a signal component contained in the original detection signal and is a peak value from the calculation result as the vibration frequency.
11. The robot apparatus according to claim 9 , wherein the calculation unit has a storage unit storing a relational expression or a table indicating a correlation between a force or a torque acting on the hand and the vibration frequency, the detection signal is input into the calculation unit and the calculation unit calculates the vibration frequency using the relational expression or the table.
12. The robot apparatus according to claim 9 , further comprising:
sending means connected to the calculation unit; and
receiving means connected to the change unit and receiving a signal indicating the vibration frequency from the sending means,
wherein the digital filter, the change unit, and the receiving means are included in the robot arm body; and the calculation unit and the sending means are arranged separately from the robot arm body.
13. A robot apparatus comprising:
a robot arm body having a plurality of links coupled through a joint portion, and a hand disposed in a distal link arranged in a distal portion of the plurality of links and gripping an object to be gripped;
a plurality of actuators driving the plurality of links and the hand;
a torque sensor including a flexible member deforming according to a torque acting on the link, and a sensor detecting an amount of deformation of the flexible member and outputting an original detection signal indicating a detection result;
a digital filter outputting a detection signal obtained by filtering the original detection signal using a filter coefficient;
a calculation unit calculating a vibration frequency of the flexible member contained in the original detection signal;
a change unit changing the filter coefficient of the digital filter to cause the digital filter to function as a filter for attenuating the vibration frequency calculated by the calculation unit; and
a control unit controlling the actuator using the detection signal output from the digital filter.
14. The robot apparatus according to claim 13 , wherein the calculation unit has a storage unit storing a relational expression or a table indicating a correlation between a torque acting on the link and the vibration frequency, the detection signal is input into the calculation unit and the calculation unit calculates the vibration frequency using the relational expression or the table.