PID控制器
where formula_2 is the control torque, formula_3 is the attitude deviation signal, and formula_4 are the PID controller parameters.