Driver station Debug

I added the driver station debug code so we can add debug