Fixed an off by 1 error in phase unwrapping, and added a diagnostic print to the FID class.