Replaced a lot of queries in GetObject and GrabMachine and its parts with designators. It can definetely make some high-level states a lot easier. This needs more work, is not done yet and this commit will break a lot of stuff.
Merge branch 'refactor/sergio+ed' of https://github.com/tue-robotics/robot_smach_states into refactor/sergio+ed
Using a simple PickUp object state from action_server, modified to use designators. Also fixed some imports
Merge branch 'refactor/sergio+ed' of https://github.com/tue-robotics/robot_smach_states into refactor/sergio+ed