Implement addNode function