Fixed the CANBus ports, added some debug statements
Fixed the CANBus ports, added some debug statements