POSE2D: Factoring pose2DInverse function.
POSE2D: Factoring pose2DInverse function.

Change-Id: Ifd87df585d65471414ad73c4eeeae88634a4dbe5

sbarthelemy/libalmath,aldebaran/libalmath,sbarthelemy/libalmath,aldebaran/libalmath