Misc. Updates for Groovy Branch

 * Better bounds checking for raytracing
 * Map Grid Visualizer Automatic Frame Selection
 * Hack to avoid end-path corner case
 * Check position before checking goal