clean up commander
add some demo code for what the planning scene interface will look like