Update QP controller

Yes, this would be great. Can you put this on me as an issue, since I probably wont get to it this week?

I think it might still be worth pulling this in so the latest QP code is out there, but I'll let you make the call :)