Method PrepareScanningProbeDataCollection

src/Movement/Move.cpp:1484–1509

This is called by DDA::Prepare when committing a scanning probe reading. The first reading has already been taken and axis0index has been incremented or decremented to account for this.

// This is called by DDA::Prepare when committing a scanning probe reading.
// The first reading has already been taken and axis0index has been incremented or decremented to account for this.
void Move::PrepareScanningProbeDataCollection(const DDA& dda, const PrepParams& params) noexcept
{
	probeControl.numReadingsNeeded = reprap.GetGCodes().GetNumScanningProbeReadingsLeftToTake();
	probeControl.nextReadingNeeded = 1;							// we already took the first reading
	if (probeControl.numReadingsNeeded != 0)
	{
		probeControl.accelClocks = params.TotalAccelClocks();
		probeControl.acceleration = params.acceleration;
		probeControl.deceleration = params.deceleration;
		probeControl.initialSpeed = dda.startSpeed;
		probeControl.topSpeed = dda.topSpeed;
		probeControl.steadyClocks = params.steadyClocks;
		probeControl.distancePerReading = params.totalDistance/(float)probeControl.numReadingsNeeded;
		probeControl.accelDistance = params.accelDistance;
		probeControl.decelStartDistance = params.decelStartDistance;
		probeControl.startTime = dda.afterPrepare.moveStartTime;
		probeControl.timer.SetCallback(ScanningProbeGlobalTimerCallback, CallbackParameter(this));
#if 0
		debugPrintf("nrn=%u ac=%" PRIu32 " sc=%" PRIu32 " is=%.3e ts=%.3e a=%.3e d=%.3e dpr=%.3f ad=%.3f dsd=%.3f\n",
					probeControl.numReadingsNeeded, probeControl.accelClocks, probeControl.steadyClocks,
					(double)probeControl.initialSpeed, (double)probeControl.topSpeed, (double)probeControl.acceleration, (double)probeControl.deceleration,
					(double)probeControl.distancePerReading, (double)probeControl.accelDistance, (double)probeControl.decelStartDistance);
#endif
		SetupNextScanningProbeReading();
	}
}

inline float fastLimSqrtf(float f) noexcept
{