Mobile body controlling gear

• US 6,088,633 A
• Filed: 03/09/1999
• Issued: 07/11/2000
• Est. Priority Date: 03/27/1998
• Status: Expired due to Term

• Current Assignee: Futaba Denshi Kogyo KK
• Original Assignee: Futaba Denshi Kogyo KK
• Inventors: Yamamoto, Michio
• Primary Examiner(s): Cuchlinski, Jr., William A.
• Assistant Examiner(s): Beaulieu, Yonel
• Application Number:
  US09/264,677
• Time in Patent Office: 490 Days
• Field of Search: 701/3, 701/8, 701/10, 701/14, 318/609, 318/610, 364/160, 364/161, 364/162, 364/163
• US Class Current: 701/3
• CPC Class Codes: A63H 30/04 using wireless transmission
• CPC Class Codes: G05B 11/42 for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
• CPC Class Codes: G05D 1/0816 to ensure stability
• CPC Class Codes: G05D 1/0858 specially adapted for vertical take-off of aircraft

Abstract

A mobile body controlling gear is provided that can suppress an occurrence of yaw motion due to an offset when the P control is switched to the PID control. The yaw-axis control signal Ep is added to the control signal from the P/PID controller. The added signal is input to the actuator. The yaw-axis driving unit performs yaw-axis control. The yaw-axis angular velocity detection sensor signal Sa is compared with the reference signal r. Then the P/PID controller receives the comparison signal. The reference value memory holds the yaw-axis control signal Ep immediately before the P/PID switching unit switches the P control mode to the PID control mode. The yaw-axis control signal Ep is handled as the reference signal rb for the PID control. The reference value rb is added to the angular velocity zero detection reference value rz and to the yaw-axis control signal Ep. The resultant sum is input to the PID terminal of the P/PID switching unit. The error between the resultant sum and the yaw-axis angular velocity sensor output Sa is output as an error to the P/PID controller.

Claims

1. A mobile body controlling gear comprising:

a controller switched to a P control mode or a PID control mode to manipulate a mobile body; and

memory means for holding a balance reference value of a control signal at a manipulation side in the P control mode;

wherein said controller controls said mobile body in the PID mode by subtracting the balance reference signal held in said memory means from an error signal input to said controller a when status is switched from the P control mode to the PID control mode, so that an offset due to the balance reference signal of the control signal in said P control mode is canceled.

3. A mobile body controlling gear defined in claim 1, wherein said mobile body is a model helicopter;

wherein said measurement value signal is a yaw-axis angular detection signal; and

wherein said controller controls a feedback of said yaw-axis angular velocity.

2. A mobile body controlling gear comprising:

a controller switched to a P control mode or a PID control mode to manipulate a mobile body; and

memory means for holding a balance reference value of a control signal at a manipulation side in the P control mode;

wherein said controller controls said mobile body in the P control mode by inputting an error of a target value and a measurement signal in the P control mode, and controls said mobile body in the PID control mode by inputting an error between the target value and said control signal on the manipulation side or between the target value and said measurement value signal in the PID control mode, and controls said mobile body in the PID control mode by subtracting said balance reference value held in said memory means from said error input to said controller when status is switched from the P control mode to the PID control mode;

said controller outputting an output signal of said controller and the control signal to said mobile body to cancel an offset due to a balance reference signal of the control signal in the P control mode.

4. A mobile body controlling gear defined in claim 2, wherein said mobile body is a model helicopter, said measurement value signal is a yaw-axis angular detection signal, and said controller controls a feedback of said yaw-axis angular velocity.

5. A mobile body controlling gear comprising:

a controller switched to a P control mode or a PID control mode to manipulate a mobile body; and

a memory configured to hold a balance reference value of a control signal at a manipulation side in the P control mode,

wherein said controller controls said mobile body in the PID mode by subtracting the balance reference signal held in said memory from an error signal input to said controller when a status is switched from the P control mode to the PID control mode, so that an offset due to the balance reference signal of the control signal in said P control mode is canceled.

7. A mobile body controlling gear defined in claim 5, wherein said mobile body is a model helicopter, said measurement value signal is a yaw-axis angular detection signal, and said controller controls a feedback of said yaw-axis angular velocity.

6. A mobile body controlling gear comprising:

a controller switched to a P control mode or a PID control mode to manipulate a mobile body; and

a memory configured to hold a balance reference value of a control signal at a manipulation side in the P control mode,

wherein said controller controls said mobile body in the P control mode by inputting an error of a target value and a measurement signal in the P control mode, and controls said mobile body in the PID control mode by inputting an error between the target value and said control signal on the manipulation side or between the target value and said measurement value signal in the PID control mode, and controls said mobile body in the PID control mode by subtracting said balance reference value held in said memory from said error input to said controller when status is switched from the P control mode to the PID control mode;

said controller outputting an output signal of said controller and the control signal to said mobile body to cancel an offset due to a balance reference signal of the control signal in the P control mode.

8. A mobile body controlling gear defined in claim 6, wherein said mobile body is a model helicopter, said measurement value signal is a yaw-axis angular detection signal, and said controller controls a feedback of said yaw-axis angular velocity.