Added debug output
Added driver station LCD message support