Fixed a fatal error possible when an invalid node ID is received in a STATUS message. Also reorganized the code to be more efficient by only making the proper ID checks depending on it it's a custom message (with a standard CAN frame type) or if it's an NMEA2000 message (with an extended CAN frame type).