Added in cruise algorithm

New cruise mode implemented, failure state is safe (goes back to standard algorithm). 2 new options added in the config file.