added program options to put the environment out in matlab readable format
added functions to help print out the environment to files
added planner epsilon field
added matlab scripts for visualizing the sets