Fixed bugs with pepperCloud2Pepper. The axes where all messed up! It turns out ellipsoid_fit minimizes arithmetic distance.