Added pr2_commande package2
Added missing parts of swift_hand
Adding scan_object
Grab and give right and tested