Vector6 fix

Add and GetMagnitude in the Vector6 class have a small error.