Added some functions to CPose2D.

- added functions to CPose2D
Added documentation and fixed several overloads.

- added docs and several class member overloads.