Add DecodeDatagram function