int TestPtToPtAndCoordOutPts()
{
	
	int iModule;
	int iError;
	double dX, dY, dZ;

	iError=InitNMCModule3Axis (iModule);

	g_stage.SetVel(3.0, 3.0, 3.0);
	g_stage.SetAccel(1.0, 1.0, 1.0);

//	g_stage.EnableAmp();
//	g_stage.ResetPos();
//	g_stage.SetPathStatus();

//Initialize path control module parameters
	g_stage.SetPathFreq(P_60HZ);
	g_stage.SetNumberOfPoints(75);
	g_stage.SetScale(15000.0, 15000.0, 15000.0);
	g_stage.SetPathAcceleration(0.175);
	g_stage.SetFeedrate(0.175);         //feedrate = 1.0 inches/second
	g_stage.SetTangentTolerance(10.0);  //continuous path tangent tolerence = 10 degrees
	g_stage.SetPathParams();     //acceleration = 1.0 inch/second/second
	g_stage.SetOrigin( 0.0, 0.0, 0.0 ); //set the origin to X = 0, Y = 0, Z = 0
	
//	g_stage.ClosePointsOut();

	return 0;
};
int InitPathParam(int pathFreq, int numberOfPts,
				  double xScale, double yScale, double zScale,
				  double pathAccel,
				  double feedrate)
{

//Initialize path control module parameters
	g_stage.SetPathFreq(pathFreq);
	g_stage.SetNumberOfPoints(numberOfPts);
	g_stage.SetScale(xScale, yScale, zScale);
	g_stage.SetPathAcceleration(pathAccel);
	g_stage.SetFeedrate(feedrate);
	g_stage.SetPathParams();     //acceleration = 1.0 inch/second/second


	g_stage.SetOrigin(0.0, 0.0, 0.0); //set the origin to X = 0, Y = 0, Z = 0
	g_stage.SetFeedrate(1.0);         //feedrate = 1.0 inches/second
	g_stage.SetTangentTolerance(10.0);  //continuous path tangent tolerence = 10 degrees

	return 0;
}