Add a helper method for querying messages.
Little warehouse loading test function.
Publishing markers for target poses.
Misc warehouse constraint stuff.
Merge branch 'master' of github.com:ibrahima/trajopt_plugin

Conflicts:
	src/move_group_battery.py