Simple fixes for CAN test app

At least this code can prove that the CAN hardware and drivers are OK.