added functions required to plot square obstacles

obstacles are still not used, but displayed in initial demo
as proof of concept