simple 2 axis lathe initial lathe set up
Posted: Sat Nov 11, 2023 2:42 am
just getting my lathe converted to cnc and are now in the code section of it
1 two DC servo motors with 2000 count encoders. X is 6mm pitch and Z axis looks to be 10mm. both will be direct coupled
2 10volt output to VFD. 3 phase spindle motor with a single ( Z right? ) from a hall sensor
so far i got the spindle working CW and CCW with accurate RPM
going to wire in the hall tomorrow. i am thinking it will run off a 5V from JP8 and then signal into JP15 opto inputs?
i got a C code example for my initial code. says pin 36 input.....
when i try and user button my init the encoders stay yellow. do the encoders need to be wired in for them to go blue?
what i got so far
1 two DC servo motors with 2000 count encoders. X is 6mm pitch and Z axis looks to be 10mm. both will be direct coupled
2 10volt output to VFD. 3 phase spindle motor with a single ( Z right? ) from a hall sensor
so far i got the spindle working CW and CCW with accurate RPM
going to wire in the hall tomorrow. i am thinking it will run off a 5V from JP8 and then signal into JP15 opto inputs?
i got a C code example for my initial code. says pin 36 input.....
when i try and user button my init the encoders stay yellow. do the encoders need to be wired in for them to go blue?
what i got so far
Code: Select all
#include "KMotionDef.h"
// counts pulses on single pulse encoder for Spindle
#define SPINDLE_PULSE_BIT 36
#define SPINDLE_AXIS 7
int main() {
int NewState, LastState = ReadBit(SPINDLE_PULSE_BIT);
for (;;) {
NewState = ReadBit(SPINDLE_PULSE_BIT);
if (NewState != LastState) {
LastState = NewState;
if (NewState) {
chan[SPINDLE_AXIS].Position++;
}
}
}
ch0->InputMode=ENCODER_MODE;
ch0->OutputMode=DAC_SERVO_MODE;
ch0->Vel=100;
ch0->Accel=1000;
ch0->Jerk=10000;
ch0->P=1;
ch0->I=0;
ch0->D=0;
ch0->FFAccel=0;
ch0->FFVel=0;
ch0->MaxI=200;
ch0->MaxErr=200;
ch0->MaxOutput=200;
ch0->DeadBandGain=1;
ch0->DeadBandRange=0;
ch0->InputChan0=0;
ch0->InputChan1=1;
ch0->OutputChan0=0;
ch0->OutputChan1=1;
ch0->MasterAxis=-1;
ch0->LimitSwitchOptions=0x100;
ch0->LimitSwitchNegBit=0;
ch0->LimitSwitchPosBit=0;
ch0->SoftLimitPos=1e+09;
ch0->SoftLimitNeg=-1e+09;
ch0->InputGain0=1;
ch0->InputGain1=1;
ch0->InputOffset0=0;
ch0->InputOffset1=0;
ch0->OutputGain=1;
ch0->OutputOffset=0;
ch0->SlaveGain=1;
ch0->BacklashMode=BACKLASH_OFF;
ch0->BacklashAmount=0;
ch0->BacklashRate=0;
ch0->invDistPerCycle=1;
ch0->Lead=0;
ch0->MaxFollowingError=1000000000;
ch0->StepperAmplitude=250;
ch0->iir[0].B0=1;
ch0->iir[0].B1=0;
ch0->iir[0].B2=0;
ch0->iir[0].A1=0;
ch0->iir[0].A2=0;
ch0->iir[1].B0=1;
ch0->iir[1].B1=0;
ch0->iir[1].B2=0;
ch0->iir[1].A1=0;
ch0->iir[1].A2=0;
ch0->iir[2].B0=1;
ch0->iir[2].B1=0;
ch0->iir[2].B2=0;
ch0->iir[2].A1=0;
ch0->iir[2].A2=0;
EnableAxis(0);
ch1->InputMode=ENCODER_MODE;
ch1->OutputMode=DAC_SERVO_MODE;
ch1->Vel=100;
ch1->Accel=1000;
ch1->Jerk=10000;
ch1->P=1;
ch1->I=0;
ch1->D=0;
ch1->FFAccel=0;
ch1->FFVel=0;
ch1->MaxI=200;
ch1->MaxErr=200;
ch1->MaxOutput=200;
ch1->DeadBandGain=1;
ch1->DeadBandRange=0;
ch1->InputChan0=1;
ch1->InputChan1=2;
ch1->OutputChan0=1;
ch1->OutputChan1=3;
ch1->MasterAxis=-1;
ch1->LimitSwitchOptions=0x100;
ch1->LimitSwitchNegBit=0;
ch1->LimitSwitchPosBit=0;
ch1->SoftLimitPos=1e+09;
ch1->SoftLimitNeg=-1e+09;
ch1->InputGain0=1;
ch1->InputGain1=1;
ch1->InputOffset0=0;
ch1->InputOffset1=0;
ch1->OutputGain=1;
ch1->OutputOffset=0;
ch1->SlaveGain=1;
ch1->BacklashMode=BACKLASH_OFF;
ch1->BacklashAmount=0;
ch1->BacklashRate=0;
ch1->invDistPerCycle=1;
ch1->Lead=0;
ch1->MaxFollowingError=1000000000;
ch1->StepperAmplitude=250;
ch1->iir[0].B0=1;
ch1->iir[0].B1=0;
ch1->iir[0].B2=0;
ch1->iir[0].A1=0;
ch1->iir[0].A2=0;
ch1->iir[1].B0=1;
ch1->iir[1].B1=0;
ch1->iir[1].B2=0;
ch1->iir[1].A1=0;
ch1->iir[1].A2=0;
ch1->iir[2].B0=1;
ch1->iir[2].B1=0;
ch1->iir[2].B2=0;
ch1->iir[2].A1=0;
ch1->iir[2].A2=0;
EnableAxis(3);
DefineCoordSystem(0,-1,1,-1);
}