layered boxes implemented, verified with wall environment
started path optimizer conversion from matlab
decoupled scene plotter from box representation module
clean up of box representation module