Dynomotion Forum

Code: Select all

#include "KMotionDef.h"
#include "cyclone.h"
#include "KflopToKMotionCNCFunctions.c"

main()
{
	printf("ToolSetZ.c started\n");
	int	Units, TWORD, HWORD, DWORD;
	double DROx, DROy, DROz, DROa, DROb, DROc, OffsetZ;
	double ZMeasured, ZDiff, ZNewOffset;
	float ZEntered;
	//float ZMeasured;
	// get current DRO reading (we only need X, but we have to handle them all)
	printf("Just about to GetDROs\n");
	GetDROs(&DROx, &DROy, &DROz, &DROa, &DROb, &DROc);
	printf("GetDros done\n");
	// get the current Units and ToolTblID (and ignore the H and D Words)
	GetMiscSettings(&Units, &TWORD, &HWORD, &DWORD);
	printf("GetMiscSettings done\n");
	// if KMotionCNC is in inch/G20 mode, then quit as it shouldn't be
	if(Units == CANON_UNITS_INCHES){
		MsgBox("KMotion set to inches. Set to MM and retry",MB_OK|MB_ICONEXCLAMATION);
		ThreadDone();
	}
	// get the Z offset from the tool table using the TWORD as index
	GetToolLength(TWORD, &OffsetZ);
	printf("GetToolLength done\n");
	// now we have those, ask the operator for the actual size
	int Answer = InputBox("Enter Z offset in MM (normally 0 if touching off)",&ZEntered);
	printf("ZEntered-%f\n",ZEntered);
	ZMeasured = ZEntered;
	printf("Value entered-%f\n",ZMeasured);
	if(Answer) {	// if true/1, then user cancelled
		MsgBox("Z Offset adjustment cancelled",MB_OK|MB_ICONEXCLAMATION);
		ThreadDone();		// and kill the thread
	} else { // else we got a value and need to do some calcs
		// first up we'll calculate the difference
		ZDiff = DROz + ZMeasured;
		printf("Z Difference-%f\n", ZDiff);
		// then the new offset with some rounding
		ZNewOffset = RoundToReasonable(OffsetZ + ZDiff,Units)*-1;
		printf("Z New Offset-%f\n",ZNewOffset);
		// and finally update the tool table
		printf("Setting new tool length\n");
		SetToolLength(TWORD, ZNewOffset);
		printf("New tool length set\n");
	}
}