Refactored qp go impl - Fixes #3