included unaltered occupancy_grid_utils from clearpathrobotics

https://github.com/clearpathrobotics/occupancy_grid_utils

this commit won't compile
added hasEndpoint
added addKnownOccupiedPoint
using WallTimer instead of Timer for interrupts
pathfinding preferring paths with fewer turns