     // HIGH BEAM
     byte value = LO_NIBBLE(data[6]);
     motorcycle_state.high_beam = (K25_High_Beam_State)value;
-    DEBUG_PRINT("High beam ");
-    if( value == 0x09 ) DEBUG_PRINT("ON");
-    else if( value == 0x0A ) DEBUG_PRINT("OFF");
-    else DEBUG_PRINT("ERROR-Other");
-    DEBUG_PRINT_LN("");
 
     // TURN SIGNAL
     value = data[7];
     motorcycle_state.turn_signals = (K25_Turn_Signals_State)value;    
-    DEBUG_PRINT("Turn Signals ");
-    if( value == 0xCF ) DEBUG_PRINT("OFF");
-    else if( value == 0xD7 ) DEBUG_PRINT("LEFT ONLY");
-    else if( value == 0xE7 ) DEBUG_PRINT("RIGHT ONLY");
-    else if( value == 0xEF ) DEBUG_PRINT("BOTH ON");
-    else DEBUG_PRINT("ERROR-Other");
-    DEBUG_PRINT_LN("");
 }
 
 void handle_MSG_ID_ZFE_Control_Module_2(unsigned char *data, unsigned char length)


#include <SPI.h>
#include "mcp_can.h"
#include "BMW_R1200_GS_K25_CAN_Bus_Defines.h"
#include "BMW_R1200_GS_K25_State.h"

/* Compile time Flags */
#define DEBUG 0

/* Helper Macros */
#define HI_NIBBLE(b) (((b) >> 4) & 0x0F)

    // BRAKE LEVERS
    byte value = LO_NIBBLE(data[6]);
    motorcycle_state.brake_levers = (K25_Brake_Lever_State)value;

    // ABS Status
    value = HI_NIBBLE(data[1]);
    motorcycle_state.abs_system = (K25_ABS_State)value;
}

void handle_MSG_ID_BMSK_Control_Module(unsigned char *data, unsigned char length)
