Revise code

- Prepare for adding more arguments, move core behavior from main
  function to a new function.
- Add more error checking.

Test: run test scripts (see libufdt/tests/README)
Change-Id: Id9afff20053beefe11af4900ef746a2d2bbad0c5