JPH04185598A - Attitude abnormality detecting method in triaxial satellite - Google Patents
Attitude abnormality detecting method in triaxial satelliteInfo
- Publication number
- JPH04185598A JPH04185598A JP2315353A JP31535390A JPH04185598A JP H04185598 A JPH04185598 A JP H04185598A JP 2315353 A JP2315353 A JP 2315353A JP 31535390 A JP31535390 A JP 31535390A JP H04185598 A JPH04185598 A JP H04185598A
- Authority
- JP
- Japan
- Prior art keywords
- wheel
- abnormality
- satellite
- attitude
- mathematical model
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 230000005856 abnormality Effects 0.000 title claims abstract description 37
- 238000000034 method Methods 0.000 title description 2
- 238000013178 mathematical model Methods 0.000 claims abstract description 14
- 238000001514 detection method Methods 0.000 claims description 26
- 230000002159 abnormal effect Effects 0.000 description 5
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
【発明の詳細な説明】
〔産業上の利用分野〕
本発明は三軸衛星における姿勢異常検出方式eこ関し、
特に三軸安定型衛星の異常を搭載計算機eこより自動的
に判断する三軸衛星における姿勢異常検出方式に関する
。[Detailed Description of the Invention] [Industrial Application Field] The present invention relates to an attitude abnormality detection method for a three-axis satellite.
In particular, the present invention relates to an attitude anomaly detection method for a three-axis stable satellite that automatically determines anomalies in a three-axis stable satellite using an onboard computer.
従来、三軸安定型衛星におけるホイールの異常検出は、
ホイール単体から出力される異常信号もしくはホイール
の異常によって誘発された衛星の姿勢の乱れを姿勢セン
サにより検出することtこより行っていた。Conventionally, wheel abnormality detection in three-axis stabilized satellites is
This was done by using an attitude sensor to detect an abnormal signal output from a single wheel or a disturbance in the attitude of the satellite induced by an abnormality in the wheel.
上述した従来のホイールの異常検出方法のうち、ホイー
ル単体から出力される異常信号を異常検出の手段とする
ものは、ホイール単体での異常検出ですべての異常を捕
捉しにくいことと、異常検出機能そのものの異常には対
応てきないという欠点がある。また、ホイールの異常に
よって誘発された姿勢の乱れを姿勢センサによって検出
する方法は、ホイールの異常発生から異常検出までの時
間におくれか生じ、その後の対策に困難が生じるという
欠点があった。Among the conventional wheel abnormality detection methods mentioned above, those that use the abnormality signal output from a single wheel as a means of abnormality detection are difficult to detect all abnormalities by detecting abnormalities in a single wheel, and the abnormality detection function The drawback is that it cannot respond to abnormalities in itself. Furthermore, the method of detecting a disturbance in posture induced by a wheel abnormality using a posture sensor has the drawback that there is a delay in the time from the occurrence of a wheel abnormality to the detection of the abnormality, making subsequent countermeasures difficult.
本発明の三軸衛星における姿勢異常検圧方式は、三軸安
定型衛星に配置したホイールの動作異常を検出して三軸
安定型衛星の姿勢異常を検出する三軸衛星における姿勢
異常検出方式であって、ホイール駆動装置を介してホイ
ールを駆動すべく印加するトルクコマンドとホイールの
回転数にもとづいて搭載計算器によりホイールの動作異
常を判断する手段を備えて構成される。The attitude abnormality detection method for a three-axis satellite of the present invention is an attitude abnormality detection method for a three-axis satellite that detects an abnormality in the attitude of a three-axis stabilized satellite by detecting an abnormality in the operation of a wheel placed on the three-axis stabilized satellite. The vehicle is configured to include means for determining abnormal operation of the wheel by an on-board calculator based on the torque command applied to drive the wheel via the wheel drive device and the number of rotations of the wheel.
また本発明の三軸衛星における姿勢異常検出方式は、前
記搭載計算器によるホイールの動作異常の判断が、時刻
tユにおけるホイールの回転数の初期値Ωa(tl)を
含んで設定する数学モデルにもとづいて得られる時刻t
2におけるホイールの回転数の予測m値Ωc(tz)と
ホイールの時間t2における実際の回転数Ωa(t2)
との差が所定の許容範囲にあるか否かの判定によって行
なう構成を有する。Further, in the attitude abnormality detection method for a three-axis satellite according to the present invention, the determination of wheel operation abnormality by the onboard calculator is based on a mathematical model set including an initial value Ωa(tl) of the wheel rotation speed at time t. The time t obtained based on
The predicted m value Ωc (tz) of the wheel rotation speed at time 2 and the actual wheel rotation speed Ωa (t2) at time t2.
The configuration is such that the determination is made by determining whether or not the difference between the
こ実旌例〕 次に、本発明についで区画を参照して説明する。This example] Next, the present invention will be described with reference to compartments.
第1図は本発明の一実箆例の構成図である。第1図に示
す実旌例は、人工衛星の空間姿勢を制御−iべく、X、
Y、:lIに配置した3つのホイールを代表して表現す
るホイール1と、上位機器からのl・ルクコマンドを受
けてホイールlを駆動するホイール駆動装置2と、人工
衛星に搭載し、予め設定する数学モデルによってホイー
ル1の動作異常を自動的に検出し、異常の場合には異常
検圧信号を上位機器に出力する搭載計算器3と、トルク
コマンドを検出するトルクコマンド検出回路4と、ホイ
ール駆動装置2によって駆動されるホイール1の実際の
回転数を検出するホイール回転数検出回路5を備えて構
成される。FIG. 1 is a block diagram of an example of the present invention. In the practical example shown in Fig. 1, in order to control the spatial attitude of an artificial satellite,
A wheel 1 representing three wheels placed at Y,:lI, a wheel drive device 2 that drives the wheel l in response to an l-lux command from a host device, and a wheel that is installed on the satellite and set in advance. The on-board calculator 3 automatically detects abnormal operation of the wheel 1 using a mathematical model that detects the abnormality, and outputs an abnormal pressure detection signal to the host device in the case of an abnormality, the torque command detection circuit 4 detects the torque command, and the wheel The wheel rotation speed detection circuit 5 is configured to detect the actual rotation speed of the wheel 1 driven by the drive device 2.
また、搭載計算器3は、トルクコマンド検出回路4の出
力と、ホイール回転数検出回路5の圧力にもとづいてホ
イール1の回転数の理想値を予測するホイール数学モデ
ル6と、ホイール回転数検出回路5の出力するホイール
Iの実際の回転数とホイール数学モデル6によっ又出力
されるホイール1の予測理想値としての回転数との差を
求める加算器8と、加算器8の出力にもとづいてホイー
ルJの異常の有無を判断する異常判断ロジック部7とを
備えて構成される。The onboard calculator 3 also includes a wheel mathematical model 6 that predicts the ideal value of the rotation speed of the wheel 1 based on the output of the torque command detection circuit 4 and the pressure of the wheel rotation speed detection circuit 5, and a wheel rotation speed detection circuit. Based on the output of the adder 8, which calculates the difference between the actual rotation speed of the wheel I outputted by the wheel mathematical model 5 and the predicted ideal rotation speed of the wheel 1 outputted by the wheel mathematical model 6, The abnormality determination logic section 7 determines whether or not there is an abnormality in the wheel J.
次に、第1図の実旅例の動作について説明する。Next, the operation of the actual journey example shown in FIG. 1 will be explained.
ホイール駆動装置2は、与えられたトルクコマントニヨ
リホイール1を駆動しリアクショントルクを発生させる
。ホイール駆動装置2から圧力されるタコパルスは、ホ
イール1の1回転当りNパルス発生するパルス信号で、
ホイール駆動装置2により生成される。The wheel drive device 2 drives the wheel 1 using a given torque command and generates a reaction torque. The tacho pulse applied by the wheel drive device 2 is a pulse signal that generates N pulses per rotation of the wheel 1.
generated by the wheel drive device 2.
ホイール回転数検出回路5は入力するタコパルスを一定
時間(1秒間)カウントすることによりホイール10回
転数を検出する。これによって検出されたタコパルスの
カウント値Mとホイール回転数Ω(rad/s)の間に
は次の(1)式の関係がある。The wheel rotation speed detection circuit 5 detects the wheel rotation speed by counting input tacho pulses for a certain period of time (1 second). The relationship between the count value M of the tacho pulses thus detected and the wheel rotation speed Ω (rad/s) is expressed by the following equation (1).
トルクコマンド検出回路4は、ホイール駆動装置2に与
えられるトルクコマンドを検出し、搭載計算機3に供給
する。The torque command detection circuit 4 detects a torque command given to the wheel drive device 2 and supplies it to the on-board computer 3.
搭載計算器3のホイール数学モデル6は、搭載計算機3
上のソフトウェアにて実現される。ホイール数学モデル
6では、検出さhたトルクコマンドTWと予め与えられ
るホイールに関する定数とにより次の(2)式の演算を
行なう。The wheel mathematical model 6 of the onboard calculator 3 is
This is realized using the above software. In the wheel mathematical model 6, the following equation (2) is calculated using the detected torque command TW and constants related to the wheel given in advance.
TW:ホイールにtl〜t2の間に加えられたトルクの
検出m(Nm、ニュートン・メータ)工W:ホイールロ
ータ慣性モーメント (kgm2)Ωa(tl):ホイ
ール回転数検出回路5の時刻t1における検出値(ra
d/s)
Ωc(tz):時刻t2におけるホイール回転数の数学
モデル6の出力
上述したΩC(を艶とt2におけるΩa(tz)との差
は加算器8によって求められ異常判断ロジック部7に供
給される。TW: Detection of torque applied to the wheel between tl and t2 m (Nm, newton meter) W: Wheel rotor moment of inertia (kgm2) Ωa (tl): Detection at time t1 by wheel rotation speed detection circuit 5 value (ra
d/s) Ωc(tz): The output of the mathematical model 6 of the wheel rotation speed at time t2. Supplied.
異常判断ロンツク部7は、時間t2におけるΩCとΩa
との差が、次の(3)式に示す如くある予め定められた
一定値εより大きくなった場合に異常信号を出力する。The abnormality judgment unit 7 calculates ΩC and Ωa at time t2.
An abnormal signal is output when the difference between the two values becomes larger than a certain predetermined constant value ε as shown in the following equation (3).
以上説明したように本発明は、三軸安定型衛星にホイー
ルの予測理想値を算出する数学モデルを設定した計算器
を搭載し、この搭載計算器によるホイールの回転数とホ
イールの実際の回転数とを比較することにより、ホイー
ルの異常、従って人工衛星の姿勢異常を自動的かつ迅速
、確実に捕捉できる効果がある。As explained above, the present invention is equipped with a calculator that is set up with a mathematical model for calculating the predicted ideal value of the wheel on a three-axis stabilized satellite, and calculates the number of rotations of the wheel and the actual number of rotations of the wheel based on the onboard calculator. By comparing the above, it is possible to automatically, quickly, and reliably detect abnormalities in the wheel and, therefore, in the attitude of the artificial satellite.
第1図は本発明の一実施例の構成図である。
l・・・・・ホイール、2・・・・・−ホイール駆動装
置、3・・・・・搭載計算機、4・・・・・・トルクコ
マンド検出回路、5・・・・・ホイール回転数検出回路
、6・・・・・・ホイール数学モデル、7・・・・異常
判断ロジック部、8・・・・・加算器。
代理人 弁理士 内 原 晋FIG. 1 is a block diagram of an embodiment of the present invention. l...Wheel, 2...-Wheel drive device, 3...On-board computer, 4...Torque command detection circuit, 5...Wheel rotation speed detection Circuit, 6...Wheel mathematical model, 7...Abnormality judgment logic section, 8...Adder. Agent Patent Attorney Susumu Uchihara
Claims (1)
出して三軸安定型衛星の姿勢異常を検出する三軸衛星に
おける姿勢異常検出方式であって、ホィール駆動装置を
介してホィールを駆動すべく印加するトルクコマンドと
ホィールの回転数にもとづいて搭載計算器によりホィー
ルの動作異常を判断する手段を備えて成ることを特徴と
する三軸衛星における姿勢異常検出方式。 2、前記搭載計算器によるホィールの動作異常の判断が
、時刻t_1におけるホィールの回転数の初期値Ωa(
t_1)を含んで設定する数学モデルにもとづいて得ら
れる時刻t_2におけるホィールの回転数の子測理想値
Ωc(t_2)とホィールの時間t_2における実際の
回転数Ωa(t_2)との差が所定の許容範囲にあるか
否かの判定によるものであることを特徴とする請求項1
記載の三軸衛星における姿勢異常検出方式。[Scope of Claims] 1. An attitude abnormality detection method for a three-axis satellite, which detects an abnormality in the attitude of a three-axis stabilized satellite by detecting an abnormality in the operation of a wheel disposed on the three-axis stabilized satellite, comprising: a wheel driving device; An attitude abnormality detection method for a three-axis satellite, characterized by comprising means for determining an abnormality in wheel operation by an on-board calculator based on a torque command applied to drive the wheel via the wheel and the number of revolutions of the wheel. 2. The on-board calculator determines whether the wheel is operating abnormally based on the initial value Ωa(of the wheel rotation speed at time t_1).
The difference between the ideal rotational speed Ωc(t_2) of the wheel at time t_2 obtained based on a mathematical model set including t_1) and the actual wheel rotational speed Ωa(t_2) at time t_2 is within a predetermined tolerance range. Claim 1 characterized in that the determination is based on whether or not
Attitude anomaly detection method for the described three-axis satellite.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2315353A JPH04185598A (en) | 1990-11-20 | 1990-11-20 | Attitude abnormality detecting method in triaxial satellite |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2315353A JPH04185598A (en) | 1990-11-20 | 1990-11-20 | Attitude abnormality detecting method in triaxial satellite |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH04185598A true JPH04185598A (en) | 1992-07-02 |
Family
ID=18064396
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2315353A Pending JPH04185598A (en) | 1990-11-20 | 1990-11-20 | Attitude abnormality detecting method in triaxial satellite |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH04185598A (en) |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0248298A (en) * | 1988-08-08 | 1990-02-19 | Mitsubishi Electric Corp | Wheel trouble detecting method for space flying body |
-
1990
- 1990-11-20 JP JP2315353A patent/JPH04185598A/en active Pending
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0248298A (en) * | 1988-08-08 | 1990-02-19 | Mitsubishi Electric Corp | Wheel trouble detecting method for space flying body |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR100226365B1 (en) | Vehicle driving recorder, vehicle travel analyzer and storage medium | |
US6470300B1 (en) | Method and system for detecting and localizing sensor defects in motor vehicles | |
JP2007516409A (en) | Method and apparatus for estimating the total mass of an automobile | |
JPH047469B2 (en) | ||
CN103313828A (en) | Robot arm and robot arm noise removal method | |
CN110285978A (en) | Kinetic parameter test method, device, storage medium and the electronic equipment of vehicle | |
JPH0331228B2 (en) | ||
JP2001524884A (en) | Method of monitoring manipulator motion control | |
JP3623582B2 (en) | Robot failure diagnosis method | |
EP0403055B1 (en) | Highly efficient method for calculating rotational speed | |
US20190286099A1 (en) | Controller | |
JPH047470B2 (en) | ||
GB2368400A (en) | Acceleration sensor fault detector | |
JPH04120434A (en) | Model supporting mechanism of wind tunnel testing apparatus | |
JPH01244976A (en) | Torsional torque signal abnormality detecting method for electric power steering device | |
JP3091388B2 (en) | Motor runaway detection method and runaway detection device | |
CN110963027B (en) | Abnormality detection device and control device | |
JPH04185598A (en) | Attitude abnormality detecting method in triaxial satellite | |
JPH11125534A (en) | Drive state recording device and drive state analyzing device | |
JPS61104215A (en) | Self-diagnosing apparatus of crank-angle sensor | |
JP2000258453A (en) | Fall detecting device | |
JP3165087B2 (en) | Industrial robot failure detection method | |
JP3246572B2 (en) | Load constant measurement method for motor drive system | |
JP4446156B2 (en) | Apparatus and method for detecting belt cutting in motor drive system | |
JPH06336199A (en) | Member damage detecting device for aircraft |