When computing kinetic energy, make sure the shifted velocities are perpendicular to the constraints
Attach a file by drag & drop or click to upload