Fix Vector2d->Vector3d