Update for experimental and other stuff
Primarily worked on my robot adding a behavior to unload in a pile, also added the function rel_pt, which takes coordinates relative to your robot and returns the global coordinates, makes it easy to specify stuff in egocentric terms and use the global map functions.