[c++] Fix bug in TaskSE3Equality: when expressing task quantities in world frame there was a mistake in the transform of the position error from local to world frame. Switch from log6 to log3 to avoid coupling between orientation error and translation error, which made task mask not work properly.