Populated the orientation field in the published pose array
Enabled debugging and added debug print statements