Complete action interface support.

- Goal completion is checked.

- Tolerance checking implemented, needs cleanup, doc and testing though.

- Reading tolerance data from goal handle and ROS param server is still TODO.