This paper describes the current control system of the multi-conjugate adaptive optics (MCAO) test bench system that is being developed at the University of Victoria, BC, Canada. The design and analysis of a control system for an AO system employing a Micro-Electro-Mechanical-System (MEMS) based deformable mirror and a PI tilt mirror is presented. This paper focuses on modal control of one deformable mirror and a tilt mirror with a Shack-Hartmann wave front sensor. Diagrams of how all the components work together as a control system are given. Bandwidth measurements for a single delay integrator controller and for a matched delay integrator are presented. Analysis shows that matching the delays of the integrator to the delays of the optical feedback loop provides considerable improvement in bandwidth.