 void handle_MSG_ID_ABS_Control_Module(unsigned char *data, unsigned char length)
 {
     // BRAKE LEVERS
-    unsigned char lnibble7 = LO_NIBBLE(data[6]);
+    unsigned char value = LO_NIBBLE(data[6]);
     DEBUG_PRINT("Brake Levers: ");
-    if( lnibble7 == 0x07 ) DEBUG_PRINT("Front");
-    else if( lnibble7 == 0x0B ) DEBUG_PRINT("Rear");
-    else if( lnibble7 == 0x03 ) DEBUG_PRINT("None");
+    if( value == 0x07 ) DEBUG_PRINT("Front");
+    else if( value == 0x0B ) DEBUG_PRINT("Rear");
+    else if( value == 0x03 ) DEBUG_PRINT("None");
     else DEBUG_PRINT("ERROR-Other");
     DEBUG_PRINT_LN("");
 
     // ABS Status
-    unsigned char lnibble2 = HI_NIBBLE(data[1]);
+    value = HI_NIBBLE(data[1]);
     DEBUG_PRINT("ABS: ");
-    if( lnibble2 == 0x05 ) DEBUG_PRINT("ON");
-    else if( lnibble2 == 0x0B ) DEBUG_PRINT("OFF");
+    if( value == 0x05 ) DEBUG_PRINT("ON");
+    else if( value == 0x0B ) DEBUG_PRINT("OFF");
     else DEBUG_PRINT("ERROR-Other");
     DEBUG_PRINT_LN("");
 }

void handle_MSG_ID_ZFE_Control_Module_2(unsigned char *data, unsigned char length)
{
    // HEATED GRIPS
    unsigned char hnibble8 = HI_NIBBLE(data[7]);
    DEBUG_PRINT("Heated Grips: ");
    if( hnibble8 == 0x0F ) DEBUG_PRINT("OFF");
    else if( hnibble8 == 0x0C ) DEBUG_PRINT("LOW");
    else if( hnibble8 == 0x0D ) DEBUG_PRINT("HIGH");
    else DEBUG_PRINT("ERROR-Other");
    DEBUG_PRINT_LN("");

    // INFO BUTTON
    unsigned char hnibble6 = HI_NIBBLE(data[5]);
    DEBUG_PRINT("Info Button: ");
    if( hnibble6 == 0x05 ) DEBUG_PRINT("SHORT PRESS");
    else if( hnibble6 == 0x06 ) DEBUG_PRINT("LONG PRESS");
    else DEBUG_PRINT("ERROR-Other");
    DEBUG_PRINT_LN("");
}

#endif

MCP_CAN CAN(9);
K25_State_t motorcycle_state;

/* Arduino Functions */
void setup()
