Found a couple of sign errors in the RATTLE update equations. This has not fixed my problems, though.