Modified Sparkfun CANBUS Read

// XirallicBolts
// Modified SparkFun code to read CANBUS
// Adds leading 0 to ID and data for improved readability

#include <Canbus.h>
#include <defaults.h>
#include <global.h>
#include <mcp2515.h>
#include <mcp2515_defs.h>

void setup(){
  Serial.begin(500000);
  //                 CANSPEED_500 for HS-CAN or I-CAN,  CANSPEED_125 for MS-CAN
  if(Canbus.init(CANSPEED_500))
    Serial.println("CAN Init ok");
  else
   Serial.println("Can't Init CAN");
  delay(1000);
}


void loop(){
tCAN message;

if (mcp2515_check_message())
{
    if (mcp2515_get_message(&message))
    {
//    if(message.id == 0x000){         // Uncomment to filter a specific ID (don't forget after the loop too)
               Serial.print("ID: ");
               if(message.id < 255)
               {
                Serial.print("0");
               }
               Serial.print(message.id,HEX);
               Serial.print(", ");
               Serial.print("Data: ");
               for(int i=0;i<message.header.length;i++)
               {
                  if(message.data[i] < 16)
                  {
                    Serial.print("0");
                  }
                  Serial.print(message.data[i],HEX);
                  Serial.print("  ");
               }
               Serial.println("");
    }
// }  // Uncomment to filter
  }
}