标签：寸动 LTSMC 功能 CardNum Delta axis smc PKM

 //x+

private void button5_Click(object sender, EventArgs e)

        {

            if (wether_link == 0)
            {
                MessageBox.Show("请先打开设备");
                return;
            }
            if (SF == 0)
            {
                MessageBox.Show("请先打开伺服");
                return;
            }
            if (machine_origin == 0)
            {
                MessageBox.Show("请先确定原点");
                return;
            }
            double[] Delta = new double[3];
            double[] PKM_Delta = new double[3];
            double[] PKM_Pstar_motor = new double[3];
            double[] PKM_Pstar_motor1 = new double[3];
            double[] theta = new double[3];
            for (int i = 0; i < axis_all.Length; i = i + 1)
            {
                LTSMC.smc_get_encoder_unit(CardNum, axis_all[i], ref PKM_Pstar_motor1[i]);//当前编码器位置
                PKM_Pstar_motor[i] = PKM_Pstar_motor1[i] / (fp / 360);//主动臂的转角（驱动器设置控制电机正反转的方向）顺时针方向为正
            }
            Forward.foward_calculate(PKM_Pstar_motor[0], PKM_Pstar_motor[1], PKM_Pstar_motor[2]);
            PKM_Delta[0] = Forward.instantaneous_Gx;
            PKM_Delta[1] = Forward.instantaneous_Gy;
            PKM_Delta[2] = Forward.instantaneous_Gz;                  //当前位置下动平台相对于静坐标系的坐标
            //让机器知道此时位置，沿着此时位置向X轴方向运动
            Delta[0] = PKM_Delta[0] + decimal.ToDouble(movement_distance.Value);
            Delta[1] = PKM_Delta[1];
            Delta[2] = PKM_Delta[2];
            Inverse.inverse_position(Delta[0], Delta[1], Delta[2]);//定点移动的距离坐标，通过逆解计算出编码器的位置，再插补到该点上。
            theta[0] = Inverse.theta1;
            theta[1] = Inverse.theta2;
            theta[2] = Inverse.theta3;
            for (int i = 0; i < axis_all.Length; i = i + 1)
            {
                LTSMC.smc_set_alm_mode(CardNum, axis_all[i], 0, 0, 0);//设置报警使能，关闭报警
                LTSMC.smc_write_sevon_pin(CardNum, axis_all[i], 0);//打开伺服使能 
            }
            double speed = gear * decimal.ToDouble(run_speed.Value) * (fp / (2 * Math.PI));      //单位：unit/s
            LTSMC.smc_set_vector_profile_unit(CardNum, 0, start, speed, acc, dec, stop);//设置插补运动速度参数       
            LTSMC.smc_set_vector_s_profile(CardNum, 0, 0, acc / 2);//设置s曲线平滑时间                                     
            LTSMC.smc_line_unit(CardNum, 0, 3, axis_all, new double[] { theta[0], theta[1], theta[2] }, 1);//运动模式，0： 相对坐标模式， 1： 绝对坐标模式
        }


        //x-
        private void button6_Click(object sender, EventArgs e)
        {
            if (wether_link == 0)
            {
                MessageBox.Show("请先打开设备");
                return;
            }
            if (SF == 0)
            {
                MessageBox.Show("请先打开伺服");
                return;
            }
            if (machine_origin == 0)
            {
                MessageBox.Show("请先确定原点");
                return;
            }
            double[] Delta = new double[3];
            double[] PKM_Delta = new double[3];
            double[] PKM_Pstar_motor = new double[3];
            double[] PKM_Pstar_motor1 = new double[3];
            double[] theta = new double[3];
            for (int i = 0; i < axis_all.Length; i = i + 1)
            {
                LTSMC.smc_get_encoder_unit(CardNum, axis_all[i], ref PKM_Pstar_motor1[i]);//当前编码器位置
                PKM_Pstar_motor[i] = PKM_Pstar_motor1[i] / (fp / 360);//主动臂的转角（驱动器设置控制电机正反转的方向）顺时针方向为正
            }
            Forward.foward_calculate(PKM_Pstar_motor[0], PKM_Pstar_motor[1], PKM_Pstar_motor[2]);
            PKM_Delta[0] = Forward.instantaneous_Gx;
            PKM_Delta[1] = Forward.instantaneous_Gy;
            PKM_Delta[2] = Forward.instantaneous_Gz;                  //当前位置下动平台相对于静坐标系的坐标
            //让机器知道此时位置，沿着此时位置向X轴方向运动
            Delta[0] = PKM_Delta[0] - decimal.ToDouble(movement_distance.Value);
            Delta[1] = PKM_Delta[1];
            Delta[2] = PKM_Delta[2];
            Inverse.inverse_position(Delta[0], Delta[1], Delta[2]);//定点移动的距离坐标，通过逆解计算出编码器的位置，再插补到该点上。
            theta[0] = Inverse.theta1;
            theta[1] = Inverse.theta2;
            theta[2] = Inverse.theta3;
            double speed = gear * decimal.ToDouble(run_speed.Value) * (fp / (2 * Math.PI));      //单位：unit/s
            LTSMC.smc_set_vector_profile_unit(CardNum, 0, start, speed, acc, dec, stop);//设置插补运动速度参数       
            LTSMC.smc_set_vector_s_profile(CardNum, 0, 0, acc / 2);//设置s曲线平滑时间                                     
            LTSMC.smc_line_unit(CardNum, 0, 3, axis_all, new double[] { Inverse.theta1, Inverse.theta2, Inverse.theta3 }, 1);//运动模式，0： 相对坐标模式， 1： 绝对坐标模式
        }
        //y+
        private void button8_Click(object sender, EventArgs e)
        {
            if (wether_link == 0)
            {
                MessageBox.Show("请先打开设备");
                return;
            }
            if (SF == 0)
            {
                MessageBox.Show("请先打开伺服");
                return;
            }
            if (machine_origin == 0)
            {
                MessageBox.Show("请先确定原点");
                return;
            }
            double[] Delta = new double[3];
            double[] PKM_Delta = new double[3];
            double[] PKM_Pstar_motor = new double[3];
            double[] PKM_Pstar_motor1 = new double[3];
            double[] theta = new double[3];
            for (int i = 0; i < axis_all.Length; i = i + 1)
            {
                LTSMC.smc_get_encoder_unit(CardNum, axis_all[i], ref PKM_Pstar_motor1[i]);//当前编码器位置
                PKM_Pstar_motor[i] = PKM_Pstar_motor1[i] / (fp / 360);//主动臂的转角（驱动器设置控制电机正反转的方向）顺时针方向为正
            }
            Forward.foward_calculate(PKM_Pstar_motor[0], PKM_Pstar_motor[1], PKM_Pstar_motor[2]);
            PKM_Delta[0] = Forward.instantaneous_Gx;
            PKM_Delta[1] = Forward.instantaneous_Gy;
            PKM_Delta[2] = Forward.instantaneous_Gz;                  //当前位置下动平台相对于静坐标系的坐标
            //让机器知道此时位置，沿着此时位置向X轴方向运动
            Delta[0] = PKM_Delta[0];
            Delta[1] = PKM_Delta[1] + decimal.ToDouble(movement_distance.Value);
            Delta[2] = PKM_Delta[2];
            Inverse.inverse_position(Delta[0], Delta[1], Delta[2]);//定点移动的距离坐标，通过逆解计算出编码器的位置，再插补到该点上。
            theta[0] = Inverse.theta1;
            theta[1] = Inverse.theta2;
            theta[2] = Inverse.theta3;
            for (int i = 0; i < axis_all.Length; i = i + 1)
            {
                LTSMC.smc_set_alm_mode(CardNum, axis_all[i], 0, 0, 0);//设置报警使能，关闭报警
                LTSMC.smc_write_sevon_pin(CardNum, axis_all[i], 0);//打开伺服使能 
            }
            double speed = gear * decimal.ToDouble(run_speed.Value) * (fp / (2 * Math.PI));      //单位：unit/s
            LTSMC.smc_set_vector_profile_unit(CardNum, 0, start, speed, acc, dec, stop);//设置插补运动速度参数       
            LTSMC.smc_set_vector_s_profile(CardNum, 0, 0, acc / 2);//设置s曲线平滑时间                                     
            LTSMC.smc_line_unit(CardNum, 0, 3, axis_all, new double[] { theta[0], theta[1], theta[2] }, 1);//运动模式，0： 相对坐标模式， 1： 绝对坐标模式
        }
        //y-
        private void button7_Click(object sender, EventArgs e)
        {
            if (wether_link == 0)
            {
                MessageBox.Show("请先打开设备");
                return;
            }
            if (SF == 0)
            {
                MessageBox.Show("请先打开伺服");
                return;
            }
            if (machine_origin == 0)
            {
                MessageBox.Show("请先确定原点");
                return;
            }
            double[] Delta = new double[3];
            double[] PKM_Delta = new double[3];
            double[] PKM_Pstar_motor = new double[3];
            double[] PKM_Pstar_motor1 = new double[3];
            double[] theta = new double[3];
            for (int i = 0; i < axis_all.Length; i = i + 1)
            {
                LTSMC.smc_get_encoder_unit(CardNum, axis_all[i], ref PKM_Pstar_motor1[i]);//当前编码器位置
                PKM_Pstar_motor[i] = PKM_Pstar_motor1[i] / (fp / 360);//主动臂的转角（驱动器设置控制电机正反转的方向）顺时针方向为正
            }
            Forward.foward_calculate(PKM_Pstar_motor[0], PKM_Pstar_motor[1], PKM_Pstar_motor[2]);
            PKM_Delta[0] = Forward.instantaneous_Gx;
            PKM_Delta[1] = Forward.instantaneous_Gy;
            PKM_Delta[2] = Forward.instantaneous_Gz;                  //当前位置下动平台相对于静坐标系的坐标
            //让机器知道此时位置，沿着此时位置向X轴方向运动
            Delta[0] = PKM_Delta[0];
            Delta[1] = PKM_Delta[1] - decimal.ToDouble(movement_distance.Value);
            Delta[2] = PKM_Delta[2];
            Inverse.inverse_position(Delta[0], Delta[1], Delta[2]);//定点移动的距离坐标，通过逆解计算出编码器的位置，再插补到该点上。
            theta[0] = Inverse.theta1;
            theta[1] = Inverse.theta2;
            theta[2] = Inverse.theta3;
            for (int i = 0; i < axis_all.Length; i = i + 1)
            {
                LTSMC.smc_set_alm_mode(CardNum, axis_all[i], 0, 0, 0);//设置报警使能，关闭报警
                LTSMC.smc_write_sevon_pin(CardNum, axis_all[i], 0);//打开伺服使能 
            }
            double speed = gear * decimal.ToDouble(run_speed.Value) * (fp / (2 * Math.PI));      //单位：unit/s
            LTSMC.smc_set_vector_profile_unit(CardNum, 0, start, speed, acc, dec, stop);//设置插补运动速度参数       
            LTSMC.smc_set_vector_s_profile(CardNum, 0, 0, acc / 2);//设置s曲线平滑时间                                     
            LTSMC.smc_line_unit(CardNum, 0, 3, axis_all, new double[] { theta[0], theta[1], theta[2] }, 1);//运动模式，0： 相对坐标模式， 1： 绝对坐标模式
        }
        //z+
        private void button10_Click(object sender, EventArgs e)
        {
            if (wether_link == 0)
            {
                MessageBox.Show("请先打开设备");
                return;
            }
            if (SF == 0)
            {
                MessageBox.Show("请先打开伺服");
                return;
            }
            if (machine_origin == 0)
            {
                MessageBox.Show("请先确定原点");
                return;
            }
            double[] Delta = new double[3];
            double[] PKM_Delta = new double[3];
            double[] PKM_Pstar_motor = new double[3];
            double[] PKM_Pstar_motor1 = new double[3];
            double[] theta = new double[3];
            for (int i = 0; i < axis_all.Length; i = i + 1)
            {
                LTSMC.smc_get_encoder_unit(CardNum, axis_all[i], ref PKM_Pstar_motor1[i]);//当前编码器位置
                PKM_Pstar_motor[i] = PKM_Pstar_motor1[i] / (fp / 360);//主动臂的转角（驱动器设置控制电机正反转的方向）顺时针方向为正
            }
            Forward.foward_calculate(PKM_Pstar_motor[0], PKM_Pstar_motor[1], PKM_Pstar_motor[2]);
            PKM_Delta[0] = Forward.instantaneous_Gx;
            PKM_Delta[1] = Forward.instantaneous_Gy;
            PKM_Delta[2] = Forward.instantaneous_Gz;                  //当前位置下动平台相对于静坐标系的坐标
            //让机器知道此时位置，沿着此时位置向X轴方向运动
            Delta[0] = PKM_Delta[0];
            Delta[1] = PKM_Delta[1];
            Delta[2] = PKM_Delta[2] - decimal.ToDouble(movement_distance.Value);
            Inverse.inverse_position(Delta[0], Delta[1], Delta[2]);//定点移动的距离坐标，通过逆解计算出编码器的位置，再插补到该点上。
            theta[0] = Inverse.theta1;
            theta[1] = Inverse.theta2;
            theta[2] = Inverse.theta3;
            for (int i = 0; i < axis_all.Length; i = i + 1)
            {
                LTSMC.smc_set_alm_mode(CardNum, axis_all[i], 0, 0, 0);//设置报警使能，关闭报警
                LTSMC.smc_write_sevon_pin(CardNum, axis_all[i], 0);//打开伺服使能 
            }
            double speed = gear * decimal.ToDouble(run_speed.Value) * (fp / (2 * Math.PI));      //单位：unit/s
            LTSMC.smc_set_vector_profile_unit(CardNum, 0, start, speed, acc, dec, stop);//设置插补运动速度参数       
            LTSMC.smc_set_vector_s_profile(CardNum, 0, 0, acc / 2);//设置s曲线平滑时间                                     
            LTSMC.smc_line_unit(CardNum, 0, 3, axis_all, new double[] { theta[0], theta[1], theta[2] }, 1);//运动模式，0： 相对坐标模式， 1： 绝对坐标模式
        }
        //z-
        private void button9_Click(object sender, EventArgs e)
        {
            if (wether_link == 0)
            {
                MessageBox.Show("请先打开设备");
                return;
            }
            if (SF == 0)
            {
                MessageBox.Show("请先打开伺服");
                return;
            }
            if (machine_origin == 0)
            {
                MessageBox.Show("请先确定原点");
                return;
            }
            double[] Delta = new double[3];
            double[] PKM_Delta = new double[3];
            double[] PKM_Pstar_motor = new double[3];
            double[] PKM_Pstar_motor1 = new double[3];
            double[] theta = new double[3];
            for (int i = 0; i < axis_all.Length; i = i + 1)
            {
                LTSMC.smc_get_encoder_unit(CardNum, axis_all[i], ref PKM_Pstar_motor1[i]);//当前编码器位置
                PKM_Pstar_motor[i] = PKM_Pstar_motor1[i] / (fp / 360);//主动臂的转角（驱动器设置控制电机正反转的方向）顺时针方向为正
            }
            Forward.foward_calculate(PKM_Pstar_motor[0], PKM_Pstar_motor[1], PKM_Pstar_motor[2]);
            PKM_Delta[0] = Forward.instantaneous_Gx;
            PKM_Delta[1] = Forward.instantaneous_Gy;
            PKM_Delta[2] = Forward.instantaneous_Gz;                  //当前位置下动平台相对于静坐标系的坐标
            //让机器知道此时位置，沿着此时位置向X轴方向运动
            Delta[0] = PKM_Delta[0];
            Delta[1] = PKM_Delta[1];
            Delta[2] = PKM_Delta[2] + decimal.ToDouble(movement_distance.Value);
            Inverse.inverse_position(Delta[0], Delta[1], Delta[2]);//定点移动的距离坐标，通过逆解计算出编码器的位置，再插补到该点上。
            theta[0] = Inverse.theta1;
            theta[1] = Inverse.theta2;
            theta[2] = Inverse.theta3;
            for (int i = 0; i < axis_all.Length; i = i + 1)
            {
                LTSMC.smc_set_alm_mode(CardNum, axis_all[i], 0, 0, 0);//设置报警使能，关闭报警
                LTSMC.smc_write_sevon_pin(CardNum, axis_all[i], 0);//打开伺服使能 
            }
            double speed = gear * decimal.ToDouble(run_speed.Value) * (fp / (2 * Math.PI));      //单位：unit/s
            LTSMC.smc_set_vector_profile_unit(CardNum, 0, start, speed, acc, dec, stop);//设置插补运动速度参数       
            LTSMC.smc_set_vector_s_profile(CardNum, 0, 0, acc / 2);//设置s曲线平滑时间                                     
            LTSMC.smc_line_unit(CardNum, 0, 3, axis_all, new double[] { theta[0], theta[1], theta[2] }, 1);//运动模式，0： 相对坐标模式， 1： 绝对坐标模式
        }

 //主动臂A+
        private void A_p_MouseDown(object sender, MouseEventArgs e)
        {
            if (wether_link == 0)
            {
                MessageBox.Show("请先打开设备");
                return;
            }
            if (SF == 0)
            {
                MessageBox.Show("请先打开设备");
                return;
            }
            ushort axis = 1;
            double speed = gear * decimal.ToDouble(run_speed.Value) * (fp / (2 * Math.PI));      //单位：unit/s
            LTSMC.smc_set_equiv(CardNum, axis, 1);//设置脉冲当量
            LTSMC.smc_set_alm_mode(CardNum, axis, 0, 0, 0);//设置报警使能，关闭报警
            LTSMC.smc_set_s_profile(CardNum, axis, 0, 0.01);//设置S段时间（0-0.05s)
            LTSMC.smc_set_profile_unit(CardNum, axis, start, speed, acc, dec, stop);//设置起始速度、运行速度、加速时间、减速时间、停止速度
            LTSMC.smc_set_dec_stop_time(CardNum, axis, dec);//设置减速停止时间
            LTSMC.smc_vmove(CardNum, axis, 1);//连续运动，1：正向，0：反向

        }
        private void A_p_MouseUp(object sender, MouseEventArgs e)
        {
            ushort axis = 1;
            LTSMC.smc_stop(CardNum, axis, 0);//减速停止运动
        }
        //主动臂A-
        private void A_m_MouseDown(object sender, MouseEventArgs e)
        {
            if (wether_link == 0)
            {
                MessageBox.Show("请先打开设备");
                return;
            }
            if (SF == 0)
            {
                MessageBox.Show("请先打开设备");
                return;
            }
            ushort axis = 1;
            double speed = gear * decimal.ToDouble(run_speed.Value) * (fp / (2 * Math.PI));      //单位：unit/s
            LTSMC.smc_set_equiv(CardNum, axis, 1);//设置脉冲当量
            LTSMC.smc_set_alm_mode(CardNum, axis, 0, 0, 0);//设置报警使能，关闭报警
            LTSMC.smc_set_s_profile(CardNum, axis, 0, 0.01);//设置S段时间（0-0.05s)
            LTSMC.smc_set_profile_unit(CardNum, axis, start, speed, acc, dec, stop);//设置起始速度、运行速度、加速时间、减速时间、停止速度
            LTSMC.smc_set_dec_stop_time(CardNum, axis, dec);//设置减速停止时间
            LTSMC.smc_vmove(CardNum, axis, 0);//连续运动，1：正向，0：反向
        }
        private void A_m_MouseUp(object sender, MouseEventArgs e)
        {
            ushort axis = 1;
            LTSMC.smc_stop(CardNum, axis, 0);//减速停止运动
        }

        //主动臂B+
        private void B_p_MouseDown(object sender, MouseEventArgs e)
        {
            {
                if (wether_link == 0)
                {
                    MessageBox.Show("请先打开设备");
                    return;
                }
                if (SF == 0)
                {
                    MessageBox.Show("请先打开设备");
                    return;
                }
                ushort axis = 2;
                double speed = gear * decimal.ToDouble(run_speed.Value) * (fp / (2 * Math.PI));      //单位：unit/s
                LTSMC.smc_set_equiv(CardNum, axis, 1);//设置脉冲当量
                LTSMC.smc_set_alm_mode(CardNum, axis, 0, 0, 0);//设置报警使能，关闭报警
                LTSMC.smc_set_s_profile(CardNum, axis, 0, 0.01);//设置S段时间（0-0.05s)
                LTSMC.smc_set_profile_unit(CardNum, axis, start, speed, acc, dec, stop);//设置起始速度、运行速度、加速时间、减速时间、停止速度
                LTSMC.smc_set_dec_stop_time(CardNum, axis, dec);//设置减速停止时间
                LTSMC.smc_vmove(CardNum, axis, 1);//连续运动，1：正向，0：反向

            }
        }
        private void B_p_MouseUp(object sender, MouseEventArgs e)
        {
            ushort axis = 2;
            LTSMC.smc_stop(CardNum, axis, 0);//减速停止运动
        }

        //主动臂B-
        private void B_m_MouseDown(object sender, MouseEventArgs e)
        {
            if (wether_link == 0)
            {
                MessageBox.Show("请先打开设备");
                return;
            }
            if (SF == 0)
            {
                MessageBox.Show("请先打开设备");
                return;
            }
            ushort axis = 2;
            double speed = gear * decimal.ToDouble(run_speed.Value) * (fp / (2 * Math.PI));      //单位：unit/s
            LTSMC.smc_set_equiv(CardNum, axis, 1);//设置脉冲当量
            LTSMC.smc_set_alm_mode(CardNum, axis, 0, 0, 0);//设置报警使能，关闭报警
            LTSMC.smc_set_s_profile(CardNum, axis, 0, 0.01);//设置S段时间（0-0.05s)
            LTSMC.smc_set_profile_unit(CardNum, axis, start, speed, acc, dec, stop);//设置起始速度、运行速度、加速时间、减速时间、停止速度
            LTSMC.smc_set_dec_stop_time(CardNum, axis, dec);//设置减速停止时间
            LTSMC.smc_vmove(CardNum, axis, 0);//连续运动，1：正向，0：反向
        }
        private void B_m_MouseUp(object sender, MouseEventArgs e)
        {
            ushort axis = 2;
            LTSMC.smc_stop(CardNum, axis, 0);//减速停止运动
        }

        //主动臂C+
        private void C_p_MouseDown(object sender, MouseEventArgs e)
        {
            if (wether_link == 0)
            {
                MessageBox.Show("请先打开设备");
                return;
            }
            if (SF == 0)
            {
                MessageBox.Show("请先打开设备");
                return;
            }
            ushort axis = 3;
            double speed = gear * decimal.ToDouble(run_speed.Value) * (fp / (2 * Math.PI));      //单位：unit/s
            LTSMC.smc_set_equiv(CardNum, axis, 1);//设置脉冲当量
            LTSMC.smc_set_alm_mode(CardNum, axis, 0, 0, 0);//设置报警使能，关闭报警
            LTSMC.smc_set_s_profile(CardNum, axis, 0, 0.01);//设置S段时间（0-0.05s)
            LTSMC.smc_set_profile_unit(CardNum, axis, start, speed, acc, dec, stop);//设置起始速度、运行速度、停止速度、加速时间、减速时间
            LTSMC.smc_set_dec_stop_time(CardNum, axis, dec);//设置减速停止时间
            LTSMC.smc_vmove(CardNum, axis, 1);//连续运动，1：正向，0：反向
        }

        private void C_p_MouseUp(object sender, MouseEventArgs e)
        {
            ushort axis = 3;
            LTSMC.smc_stop(CardNum, axis, 0);//减速停止运动
        }

        //主动臂C-
        private void C_m_MouseDown(object sender, MouseEventArgs e)
        {
            if (wether_link == 0)
            {
                MessageBox.Show("请先打开设备");
                return;
            }
            if (SF == 0)
            {
                MessageBox.Show("请先打开设备");
                return;
            }
            ushort axis = 3;
            double speed = gear * decimal.ToDouble(run_speed.Value) * (fp / (2 * Math.PI));      //单位：unit/s
            LTSMC.smc_set_equiv(CardNum, axis, 1);//设置脉冲当量
            LTSMC.smc_set_alm_mode(CardNum, axis, 0, 0, 0);//设置报警使能，关闭报警
            LTSMC.smc_set_s_profile(CardNum, axis, 0, 0.01);//设置S段时间（0-0.05s)
            LTSMC.smc_set_profile_unit(CardNum, axis, start, speed, acc, dec, stop);//设置起始速度、运行速度、停止速度、加速时间、减速时间
            LTSMC.smc_set_dec_stop_time(CardNum, axis, dec);//设置减速停止时间
            LTSMC.smc_vmove(CardNum, axis, 0);//连续运动，1：正向，0：反向
        }

        private void C_m_MouseUp(object sender, MouseEventArgs e)
        {
            ushort axis = 3;
            LTSMC.smc_stop(CardNum, axis, 0);//减速停止运动
        }
        ////急停
        private void stop_now_Click(object sender, EventArgs e)
        {
            LTSMC.smc_emg_stop(CardNum);
        }

      int machine_origin = 0;
        private void confirm_zero_Click(object sender, EventArgs e)
        {
            if (wether_link == 0)
            {
                MessageBox.Show("请先打开设备");
                return;
            }
            else
            {
                ushort[] axis = { 1, 2, 3 };
                for (int i = 0; i < axis.Length; i = i + 1)
                {
                    LTSMC.smc_set_encoder_unit(CardNum, axis[i], 0);
                    LTSMC.smc_set_position_unit(CardNum, axis[i], 0);
                }
                machine_origin = 1;
                MessageBox.Show("原点已校准！");
            }
          

        }

标签：寸动,LTSMC,功能,CardNum,Delta,axis,smc,PKM
来源： https://www.cnblogs.com/charles48789982/p/14348654.html

本站声明： 1. iCode9 技术分享网（下文简称本站）提供的所有内容，仅供技术学习、探讨和分享；
2. 关于本站的所有留言、评论、转载及引用，纯属内容发起人的个人观点，与本站观点和立场无关；
3. 关于本站的所有言论和文字，纯属内容发起人的个人观点，与本站观点和立场无关；
4. 本站文章均是网友提供，不完全保证技术分享内容的完整性、准确性、时效性、风险性和版权归属；如您发现该文章侵犯了您的权益，可联系我们第一时间进行删除；
5. 本站为非盈利性的个人网站，所有内容不会用来进行牟利，也不会利用任何形式的广告来间接获益，纯粹是为了广大技术爱好者提供技术内容和技术思想的分享性交流网站。