cmake find didnt work for eigen so I added absolute reference to eigen
fixed bug (sign) quatTorpy
added function quatToYpr