PIDMIMO:

-------------------------------------------------------------------------------
   Produces a state space 3-axis PID controller of the form

   x(k+1) = a x(k) + b u(k)
   y(k)   = c x(k) + d u(k)

   By designing in the frequency domain and converting to discrete
   time using a zero-order hold. The inputs are the desired damping
   ratio and undamped natural frequency of the complex mode of the
   closed-loop system and the time constant of the integrator.

   This system does not compensate for the phase lag of the zero order
   hold and is only applicable to systems where the bandwidth is
   much lower than the half-sampling frequency. The continuous time
   equivalent for each axis is

               Kr s         u
   y = Kp u +  ---- u + Ki ---
              s + wR        s

   The function converts the result to discrete time if tSamp is entered.
                   
-------------------------------------------------------------------------------
   Form:
   [a, b, c, d] = PIDMIMO( inr, zeta, omega, tauInt, omegaR, tSamp, sType )
-------------------------------------------------------------------------------

   ------
   Inputs
   ------
   inr           (n,n)    Inertia matrix
   zeta          (n,1)    Vector of damping ratios
   omega         (n,1)    Vector of undamped natural frequencies
   tauInt        (n,1)    Vector of integrator time constants
   omegaR        (n,1)    Vector of derivative term roll-off frequencies
   tSamp                  Sampling period
   sType                  State equation type ('Delta' or 'Z')

   -------
   Outputs
   -------
   a             (2n,2n)  Plant matrix
   b             (2n, n)  Input matrix
   c             ( n,2n)  Output matrix
   d             ( n, n)  Feedthrough matrix
   k                      Gains
                          .kF Forward
                          .kR Rate
                          .kI Integral

-------------------------------------------------------------------------------

Children:

Common: Control/C2DZOH
Common: Control/C2DelZOH
Common: Control/FResp