Change PoseCost to be l2-norm (instead of squared l2-norm)