Add loadGridData util func
Rename signal_handler to signalHandler
Add start and goal points for betelbot config
Clean up pathfinder code
Save particle filter code

Not in working state yet