Made baxter_utilities into library, cleaned up enable sonar script
Tweaking pick_place