Angular velocity measuring device and leg-moving robot
First Claim
1. An angular velocity measuring device comprising:
- a first sensor for generating a detected output of an angular velocity;
a second sensor for generating a detected output of an angular velocity with lower drift of the detected output than in the first sensor;
a high-frequency pass filter for being inputted the detected output of the first sensor and outputting higher frequency components than a predetermined frequency in the detected output;
storage means for sequentially storing output values of the high-frequency pass filter;
subtraction means for sequentially performing operations of subtracting an output value at a time a predetermined time period earlier, which is stored in the storage means, from the output value of the high-frequency pass filter; and
addition means for sequentially performing operations of adding a value obtained by the subtraction means to the output value of the second sensor, wherein a value obtained by the addition means is obtained as an angular velocity measurement.
1 Assignment
0 Petitions
Accused Products
Abstract
An angular velocity measuring device (1) includes a first sensor (2) (vibration gyro) and a second sensor (3) (gas rate gyro). The detection output of the first sensor (2) is inputted to a high pass filter (4). Output of the filter (4) is stored and held in time series in a memory (10). Subtraction processing means (11) successively executes processing of subtracting the output of the filter (4) ωv′(t−tsd) before a predetermined time tsd from the output of the filter (4) ωv′(1). The value thus obtained is successively added to the output of the second sensor (3) ωg(t) by addition processing means (12) so as to obtain the measurement value of the angular velocity. Thus, it is possible to provide an angular velocity measuring device capable of giving an angular velocity measurement value having a high response and stability at a reasonable cost.
-
Citations
5 Claims
-
1. An angular velocity measuring device comprising:
- a first sensor for generating a detected output of an angular velocity;
a second sensor for generating a detected output of an angular velocity with lower drift of the detected output than in the first sensor;
a high-frequency pass filter for being inputted the detected output of the first sensor and outputting higher frequency components than a predetermined frequency in the detected output;
storage means for sequentially storing output values of the high-frequency pass filter;
subtraction means for sequentially performing operations of subtracting an output value at a time a predetermined time period earlier, which is stored in the storage means, from the output value of the high-frequency pass filter; and
addition means for sequentially performing operations of adding a value obtained by the subtraction means to the output value of the second sensor, wherein a value obtained by the addition means is obtained as an angular velocity measurement. - View Dependent Claims (2, 3)
- a first sensor for generating a detected output of an angular velocity;
-
4. A leg-moving robot comprising:
-
two legs extending from an upper body; an angular velocity measuring device, which includes;
a first sensor for generating a detected output of an angular velocity;
a second sensor for generating a detected output of an angular velocity with lower drift of the detected output than in the first sensor;
a high-frequency pass filter for receiving an input of the detected output of the first sensor and outputting higher frequency components than a predetermined frequency in the detected output;
storage means for sequentially storing output values of the high-frequency pass filter;
subtraction means for sequentially performing operations of subtracting an output value at a time a predetermined time period earlier, which is stored in the storage means, from the output value of the high-frequency pass filter; and
addition means for sequentially performing operations of adding a value obtained by the subtraction means to the output value of the second sensor, wherein a value obtained by the addition means is obtained as an angular velocity measurement;posture angle estimation means for estimating a posture angle of a predetermined portion at least on the basis of the angular velocity measurement obtained by the angular velocity measuring device; and control means for generating a joint drive command signal of the robot at least on the basis of the posture angle estimated by the posture angle estimation means, wherein a joint actuator for driving the joint of the robot is activated according to the joint drive command signal. - View Dependent Claims (5)
-
Specification