Add test cases and make minor edits.

* Remove unused variables from updateRHS1.
* Add two test cases.
* Tag points that are outside the body.