Developing Multivariable Control Systems for Robotics