Spark error handling

[jdugan0]

Currently, the only place in code that handles spark errors is the odometry thread. It also doesn't handle these spark errors ideally, stopping all of pivot odometry on an error. Add error handling to more places and improve the error handling in the thread.