Implement handle_node_id_packet
Fix node discover