Update QP controller

That sounds good to me. What's your preference on file locations? ControllerData.m and GenericSharedData.m in util and QPControllerData in systems/controllers?