RTCP 5 axis machine

[TomKerekes]

Hi Igor,

Here is the file you attached. It is different. Which one are you using?

[Igor]

The last correct, if you select any configuration file, the blinking does not disappear

[TomKerekes]

Hi Igor,

I don't understand. Why did you send the file with the line still in?

You must re-boot KFLOP after removing the line.

[Igor]

The last, with the line removed! And the blinking problem persists on any other configuration files! Error should be ignored

[TomKerekes]

Hi Igor,

Please put more effort into your responses. Respond completely to everything, not just one thing. otherwise things take much longer to solve.

Did you re-boot KFLOP after removing the line?

[Igor]

yes. What exactly do you mean by "download"?

[TomKerekes]

Hi Igor,

I don't recall saying "download". Did you mean "re-boot"?

You might Flash "New Version" if you Flashed anything such as KStepPresent=TRUE to remove it. Did you ever Flash anything into KFLOP? We don't recommend ever doing this. To be absolutely sure Flash "New Version" to be sure KFLOP is in a default state.

[Igor]

Hi Tom thank you the blinking problem is gone. Did I understand correctly that every time you change your programs, you need to update Flash? I have very convenient scripts for mach 3. How do I implement this functionality in Kflop? Search for the center of the procurement, search for the angle, with output for each operator on a separate button. There are ready-made templates? And how to engage them. I worked for many years with mach 3, here decided to try your program, people say that one of the best available solutions.

[TomKerekes]

Hi Igor,

Did I understand correctly that every time you change your programs, you need to update Flash?

No. You should never Flash User Programs. Only Flash New Version to keep KFLOP in a virgin default state every power up.

I have very convenient scripts for mach 3. How do I implement this functionality in Kflop? Search for the center of the procurement, search for the angle, with output for each operator on a separate button.

You would need to re-write those into KFLOP C Programs and assign the programs to Buttons in KMotionCNC.

Here is a great example written by Jeremy Brown. He has a link to the code in the comments.



Here is an updated Version (untested)

Code: Select all

#include "KMotionDef.h"
#define TMP 10					// which spare persist to use to transfer data
#include "..\KflopToKMotionCNCFunctions.c"

// Probe Example to find top, left, bottom of part

void MoveNorth(double distance);
void MoveSouth(double distance);
void MoveWest(double distance);
void MoveEast(double distance);
void MoveUp(double distance);
void MoveDown(double distance);

void MoveXToDest(double destination);
void MoveYToDest(double destination);

void ProbeDown();
void ProbeNorth();
void ProbeSouth();
void ProbeWest();
void ProbeEast();

// Globals
float xRes, yRes, zRes;

#define PROBEBIT 171			// #110
#define PROBESPEED 500.0f		// #111
#define XAXIS 0					// #112
#define YAXIS 1					// #113
#define ZAXIS 2					// #114
#define UPSPEED 2000.0f			// #115
#define DOWNSPEED (PROBESPEED * -1.0f)	// #116
#define WESTSPEED -1000.0f		// #117
#define EASTSPEED 1000.0f		// #118
#define NORTHSPEED 1000.0f		// #119
#define SOUTHSPEED -1000.0f		// #120
#define PLATETHICKNESS 0.621f	// #121
#define SAFEZ 3.0f				// #122
#define PLATEDEPTH 3.0f			// #123
#define PLATEWIDTH 3.0f			// #124
#define BUFFERDISTANCE 0.1f		// #125
#define PROBEDEPTH 0.6f			// #126
#define RIGHTCORNEROFFSET 0.5f	// #127
#define MAXIMUMTOOLDIAMETER 0.5f	// #128
#define LEFTCORNEROFFSET 0.75f	// #129

void main()
{
	printf("\n\nStarting main\n");

	double nTouch, sTouch, wTouch, eTouch;
	double nHole, sHole, wHole, eHole;
	double approxXAxisHoleZero, approxYAxisHoleZero;
	double toolWidth, toolDepth;

	printf("Getting Axis Resolution\n");
	DoPCInt(PC_COMM_GETAXISRES, TMP);

	xRes = *(float *)&persist.UserData[TMP];
	yRes = *(float *)&persist.UserData[TMP+1];
	zRes = *(float *)&persist.UserData[TMP+2];

	printf("Axis Resolutions Found:\n\tx: %f\n\ty: %f\n\tz: %f\n", xRes, yRes, zRes);

	// Find Z Height
	ProbeDown();
	printf("Setting Z DRO to plate thickness: %f\n", PLATETHICKNESS);
	DoPCFloat(PC_COMM_SET_Z, PLATETHICKNESS);

	// Find N side of plate
	MoveUp(BUFFERDISTANCE);
	MoveNorth(PLATEDEPTH - LEFTCORNEROFFSET + BUFFERDISTANCE);
	MoveDown(PROBEDEPTH);
	ProbeSouth();

	printf("Setting nTouch to ch1->Dest: %f\n", chan[YAXIS].Dest);
	nTouch = chan[YAXIS].Dest;

	// Find E side of plate
	MoveNorth(BUFFERDISTANCE);
	MoveUp(PROBEDEPTH);
	MoveSouth(BUFFERDISTANCE + RIGHTCORNEROFFSET);
	MoveEast(PLATEWIDTH - LEFTCORNEROFFSET + BUFFERDISTANCE);
	MoveDown(PROBEDEPTH);
	ProbeWest();

	printf("Setting eTouch to chan[XAXIS].Dest: %f\n", chan[XAXIS].Dest);
	eTouch = chan[XAXIS].Dest;

	// Find W side of plate
	MoveEast(BUFFERDISTANCE);
	MoveUp(PROBEDEPTH);
	MoveWest(BUFFERDISTANCE + PLATEWIDTH + BUFFERDISTANCE + MAXIMUMTOOLDIAMETER);
	MoveDown(PROBEDEPTH);
	ProbeEast();

	printf("Setting wTouch to chan[XAXIS].Dest: %f\n", chan[XAXIS].Dest);
	wTouch = chan[XAXIS].Dest;

	// Calculate Tool Width
	toolWidth = (eTouch - wTouch) / xRes - PLATEWIDTH;
	printf("toolWidth calculated as %f\n", toolWidth);

	// Find S side of plate
	MoveWest(BUFFERDISTANCE);
	MoveUp(PROBEDEPTH);
	MoveEast(BUFFERDISTANCE + PLATEWIDTH - RIGHTCORNEROFFSET + (toolWidth / 2.0));
	MoveSouth(PLATEDEPTH + MAXIMUMTOOLDIAMETER);
	MoveDown(PROBEDEPTH);
	ProbeNorth();

	printf("Setting sTouch to chan[YAXIS].Dest: %f\n", chan[YAXIS].Dest);
	sTouch = chan[YAXIS].Dest;

	toolDepth = (nTouch - sTouch) / yRes - PLATEDEPTH;
	printf("toolDepth calculated as %f\n", toolDepth);

	// Move to Hole Center
	MoveSouth(BUFFERDISTANCE);
	MoveUp(PROBEDEPTH);
	MoveNorth(BUFFERDISTANCE + LEFTCORNEROFFSET + (toolDepth / 2.0));
	MoveWest(PLATEWIDTH - RIGHTCORNEROFFSET - LEFTCORNEROFFSET);
	MoveDown(PROBEDEPTH);

	printf("Setting approxXAxisHoleZero to %f\n", chan[XAXIS].Dest);
	approxXAxisHoleZero = chan[XAXIS].Dest;
	printf("Setting approxYAxisHoleZero to %f\n", chan[YAXIS].Dest);
	approxYAxisHoleZero = chan[YAXIS].Dest;

	// Find Exact Hole Center
	ProbeWest();
	wHole = chan[XAXIS].Dest;
	MoveXToDest(approxXAxisHoleZero);
	ProbeEast();
	eHole = chan[XAXIS].Dest;
	MoveWest(((eHole - wHole) / 2.0) / xRes);

	printf("Setting X DRO to Zero\n");
	DoPCFloat(PC_COMM_SET_X, 0.0f);

	ProbeNorth();
	nHole = chan[YAXIS].Dest;
	MoveYToDest(approxYAxisHoleZero);
	ProbeSouth();
	sHole = chan[YAXIS].Dest;
	MoveNorth(((nHole - sHole) / 2.0) / yRes);

	printf("Setting Y DRO to Zero\n");
	DoPCFloat(PC_COMM_SET_Y, 0.0f);

	MoveUp(SAFEZ);

	printf("Done\n");
}

void MoveNorth(double distance)
{
	printf("Moving North by %f\n", distance);
	MoveRel(YAXIS, distance * yRes);
	while (!CheckDone(YAXIS));
}

void MoveSouth(double distance)
{
	printf("Moving South by %f\n", distance);
	MoveRel(YAXIS, -1 * distance * yRes);
	while (!CheckDone(YAXIS));
}

void MoveWest(double distance)
{
	printf("Moving West by %f\n", distance);
	MoveRel(XAXIS, -1 * distance * xRes);
	while (!CheckDone(XAXIS));
}

void MoveEast(double distance)
{
	printf("Moving East by %f\n", distance);
	MoveRel(XAXIS, distance * xRes);
	while (!CheckDone(XAXIS));
}

void MoveUp(double distance)
{
	printf("Moving Up by %f\n", distance);
	MoveRel(ZAXIS, distance * zRes);
	while (!CheckDone(ZAXIS));
}

void MoveDown(double distance)
{
	printf("Moving Down by %f\n", distance);
	MoveRel(ZAXIS, -1 * distance * zRes);
	while (!CheckDone(ZAXIS));
}

void MoveXToDest(double destination)
{
	printf("Moving XAXIS to %f\n", destination);
	Move(XAXIS, destination);
	while (!CheckDone(XAXIS));
}

void MoveYToDest(double destination)
{
	printf("Moving YAXIS to %f\n", destination);
	Move(YAXIS, destination);
	while (!CheckDone(YAXIS));
}

void ProbeDown()
{
	printf("Jogging Down at speed:%f\n", DOWNSPEED);
	Jog(ZAXIS, DOWNSPEED);
	printf("Waiting for probe to read high\n");
	while (!ReadBit(PROBEBIT));
	printf("Stopping\n");
	Jog(ZAXIS, 0);
	printf("Waiting for Z motion to stop\n");
	while (!CheckDone(ZAXIS));
}

void ProbeSouth()
{
	printf("Jogging South at speed:%f\n", SOUTHSPEED);
	Jog(YAXIS, SOUTHSPEED);
	printf("Waiting for probe to read high\n");
	while (!ReadBit(PROBEBIT));
	printf("Stopping\n");
	Jog(YAXIS, 0);
	printf("Waiting for Y motion to stop\n");
	while (!CheckDone(YAXIS));
}

void ProbeNorth()
{
	printf("Jogging North at speed:%f\n", NORTHSPEED);
	Jog(YAXIS, NORTHSPEED);
	printf("Waiting for probe to read high\n");
	while (!ReadBit(PROBEBIT));
	printf("Stopping\n");
	Jog(YAXIS, 0);
	printf("Waiting for Y motion to stop\n");
	while (!CheckDone(YAXIS));
}

void ProbeWest()
{
	printf("Jogging West at speed:%f\n", WESTSPEED);
	Jog(XAXIS, WESTSPEED);
	printf("Waiting for probe to read high\n");
	while (!ReadBit(PROBEBIT));
	printf("Stopping\n");
	Jog(XAXIS, 0);
	printf("Waiting for X motion to stop\n");
	while (!CheckDone(XAXIS));
}

void ProbeEast()
{
	printf("Jogging East at speed:%f\n", EASTSPEED);
	Jog(XAXIS, EASTSPEED);
	printf("Waiting for probe to read high\n");
	while (!ReadBit(PROBEBIT));
	printf("Stopping\n");
	Jog(XAXIS, 0);
	printf("Waiting for X motion to stop\n");
	while (!CheckDone(XAXIS));
}