Add actually SJA1000 routine