Update QP controller

maybe controlUtil.h (camelCase?)  since it's not a class.