ALMATH: add function toVector to PositionAndVelocity struc

Add test toVector for all available type

Change-Id: I83ac697b7704591519e9d7d4a7364262bae334fa
port to qidoc3

Change-Id: I833477fc0574afea223209d48b50ed9ead6647c7
ALMATH: fix doxygen

Change-Id: I8b59c97f9e9d375a32dcee67a0a54a93d7798e12