Changed mathutil filenames for consistency, added line equation computation
Added maputil package for operations on OccupancyGrid