Hi All,
Today I finally found the right setting
based on this post from @LorenzMeier
Using the LOCAL_POSITION_ESTIMATOR I have changed MPC_Z_P from 1.0 to 0.2 and it helped a lot !!! It is in fact perfect now !!!
This is simply awesome I love it !!!
Thanks a lot guys
Regards,
pturcotte