Have a look around and join today!
https://forum.seemecnc.com/forum/
https://forum.seemecnc.com/forum/viewtopic.php?f=113&t=11246
The accel board and newer firmware are the bare minimums for this all to work.Tonkabot wrote:I have a Max V2 with upgraded arms from Brian. What would I have to do to add this capability to my machine?
I assume I would need the accelerometer board and newer software in my Rambo... And then mount my head in that new board?
Brynn
Code: Select all
float tapZProbe(float x,float y)
{
Com::printF(PSTR("Probing x: "),x);
Com::printFLN(PSTR(" | y: "),y);
float sum1 = 0, sum = 0, last,oldFeedrate = Printer::feedrate;
int32_t probeSensitivity = Z_PROBE_SENSITIVITY;
bool failedProbe = false;
do {
Printer::moveTo(x,y,IGNORE_COORDINATE,IGNORE_COORDINATE,EEPROM::zProbeXYSpeed());
sum1 = Printer::runZProbe(true,false,Z_PROBE_REPETITIONS,false); //First tap
sum = Printer::runZProbe(true,false,Z_PROBE_REPETITIONS,false); //Second tap
if ((sum1 - sum) > Z_PROBE_TOLERANCE || (sum1 - sum) < - Z_PROBE_TOLERANCE){ //tap reports distance, if more or less than .1mm, it will re-run
Com::printFLN(PSTR("Z probe failed on sensitivity: "), probeSensitivity );
if(probeSensitivity < Z_PROBE_MAX_SENSITIVITY){
accelerometer_recv(0x32);
probeSensitivity+=2;
Com::printFLN(PSTR("Setting Probe Sensitivity To:"), probeSensitivity );
accelerometer_write(0x32,uint8_t(probeSensitivity)); //INT1 THRESHOLD
accelerometer_write(0x3A,uint8_t(probeSensitivity)); //CLICK THRESHOLD
accelerometer_recv(0x32);
}
sum = -1; failedProbe = true;
continue;
}else{
sum = (sum + sum1) / 2; failedProbe = false;
}
}while(failedProbe);
return (sum - Z_PROBE_BED_DISTANCE);
}Code: Select all
case 135: // G135 3 points, build average or distortion compensation
float results[10];
Com::printFLN(PSTR("auto bed level"));
if(com->hasI()){
// Parameter I initialize all to défault parameters
EEPROM::setDeltaTowerXOffsetSteps(0); // set X offset to 0
EEPROM::setDeltaTowerYOffsetSteps(0); // set Y offset to 0
EEPROM::setDeltaTowerZOffsetSteps(0); // set Z offset to 0
Printer::radius0 = 144;
Printer::zLength = 365;
EEPROM::setdeltaAlphaA(210);
EEPROM::setdeltaAlphaB(330);
EEPROM::setdeltaAlphaC(90);
EEPROM::setdeltaDiagonalRodLength(290.8);
EEPROM::storeDataIntoEEPROM(); // store offsets to 0 before doing anything
EEPROM::readDataFromEEPROM();
}
Printer::homeAxis(true,true,true);
GCode::executeFString(Com::tZProbeStartScript);
Printer::setAutolevelActive(false);
//Plateau réduit cage plexi, rayon 130
results[0]=tapZProbe(0,130);
results[1]=tapZProbe(112.58,65);
results[2]=tapZProbe(112.58,-65);
results[3]=tapZProbe(0,-130);
results[4]=tapZProbe(-112.58,-65);
results[5]=tapZProbe(-112.58,65);
results[6]=tapZProbe(0,65);
results[7]=tapZProbe(56.29,-32.5);
results[8]=tapZProbe(-56.29,-32.5);
results[9]=tapZProbe(0,0);
Com::printF(PSTR("IP: "),Printer::zLength);
Com::printF(PSTR(" "),Printer::radius0);
Com::printFLN(PSTR(" "),EEPROM::deltaDiagonalRodLength());
Com::printF(PSTR("ES: "),EEPROM::deltaTowerXOffsetSteps());
Com::printF(PSTR(" "),EEPROM::deltaTowerYOffsetSteps());
Com::printFLN(PSTR(" "),EEPROM::deltaTowerZOffsetSteps());
Com::printF(PSTR("AN: "),EEPROM::deltaAlphaA()-210);
Com::printF(PSTR(" "),EEPROM::deltaAlphaB()-330);
Com::printFLN(PSTR(" "),EEPROM::deltaAlphaC()-90);
Com::printFLN(PSTR("P0: "),results[0]);
Com::printFLN(PSTR("P1: "),results[1]);
Com::printFLN(PSTR("P2: "),results[2]);
Com::printFLN(PSTR("P3: "),results[3]);
Com::printFLN(PSTR("P4: "),results[4]);
Com::printFLN(PSTR("P5: "),results[5]);
Com::printFLN(PSTR("P6: "),results[6]);
Com::printFLN(PSTR("P7: "),results[7]);
Com::printFLN(PSTR("P8: "),results[8]);
Com::printFLN(PSTR("P9: "),results[9]);
GCode::executeFString(Com::tZProbeEndScript);
Printer::homeAxis(true,true,true);
break;
)Code: Select all
case 663: //M663 set X Y Z endstop
if(com->hasX()){
EEPROM::setDeltaTowerXOffsetSteps((float)com->X);
Com::printFLN(PSTR("Xstop changed to "),(int16_t)com->X);
}
if(com->hasY()){
EEPROM::setDeltaTowerYOffsetSteps((float)com->Y);
Com::printFLN(PSTR("Ystop changed to "),(int16_t)com->Y);
}
if(com->hasZ()){
EEPROM::setDeltaTowerZOffsetSteps((float)com->Z);
Com::printFLN(PSTR("Zstop changed to "),(int16_t)com->Z);
}
EEPROM::storeDataIntoEEPROM();
EEPROM::readDataFromEEPROM();
break;
case 664: //M664 set X Y Z Towers alpha
if(com->hasX()){
EEPROM::setdeltaAlphaA(210+(float)com->X);
Com::printFLN(PSTR("X Tower Alpha changed to "),210+(float)com->X);
}
if(com->hasY()){
EEPROM::setdeltaAlphaB(330+(float)com->Y);
Com::printFLN(PSTR("Y Tower Alpha changed to "),330+(float)com->Y);
}
if(com->hasZ()){
EEPROM::setdeltaAlphaC(90+(float)com->Z);
Com::printFLN(PSTR("Z Tower Alpha changed to "),90+(float)com->Z);
}
EEPROM::storeDataIntoEEPROM();
EEPROM::readDataFromEEPROM();
break;
case 665: //M665 set radius, rod lenght and home height
if(com->hasR()){
Printer::radius0 = (float)com->R;
Com::printFLN(PSTR("Radius changed to "),Printer::radius0);
}
if(com->hasZ()){
Printer::zLength = (float)com->Z;
Com::printFLN(PSTR("Home Height changed to "),Printer::zLength);
}
if(com->hasD()){
EEPROM::setdeltaDiagonalRodLength((float)com->D);
Com::printFLN(PSTR("Rod Lenght changed to "),(float)com->D);
}
if (com->hasR() || com->hasH()){
EEPROM::storeDataIntoEEPROM();
}
EEPROM::readDataFromEEPROM();
break;
)