Fix find_nodes implementation and add tests.
Code formatting