Return granted qos in subscribe callback

Implemented through CODE SMELL. Strongly consider revising!
Closes #38