Firefighters deviate

*Firefighters will deviate with a given probability +-2.5 meters in the x axis.
*Added some sanity checking to the speed of the nodes. The program will break when certain limits are exceeded.