initial obstacle impl.
code organization, and minor performance enhancements
nit: converting points back to World coord
adding testing obstacles (Rocks)