outfile implemented
sensor in a faster fashion
lcd_ functions
set_sensors as macro
OnFwd and OnRev