added Polygon class
added vector subtraction function
moved robot outer geometry to be internal attribute
obstacles exist
color adjustments