Add Vec3 utility
Add BoxConstraint tests