Beispiel #1
0
        void AxleShowLight(int PWMSt, int IOSt)
        {
            S2data.SetSignEnLimit((PWMSt >> 7) & 0x1);
            S2data.SetSignEnOrigin((PWMSt >> 8) & 0x1);
            S2data.SetSignReLimit((PWMSt >> 9) & 0x1);
            S2data.SetSignReOrigin((PWMSt >> 10) & 0x1);


            if (S2data.Axis == 0)
            {
                ShowLight((PWMSt >> 1 & 0x1), lbXLedbusy);  //灯光-忙
                ShowLight((PWMSt >> 3 & 0x1), lbXLedlimtp); //灯光-正极限
                ShowLight((PWMSt >> 4 & 0x1), lbXLedhome);  //灯光-原点
                ShowLight((PWMSt >> 5 & 0x1), lbXLedlimtn); //灯光-负极限
                ShowLight((PWMSt >> 6 & 0x1), lbXLedretu);  //灯光-回原点
                ShowLight((IOSt & 0x1), lbXLedpuls);        //灯光-脉冲
                ShowLight((IOSt & 0x2), lbXLeddire);        //灯光-方向

                ShowLight((PWMSt >> 7 & 0x1), lbXLedlimte); //灯光-极限使能
                ShowLight((PWMSt >> 8 & 0x1), lbXLedhe);    //灯光-原点使能
                ShowLight((PWMSt >> 9 & 0x1), lbXLedlimti); //灯光-反极限使能
                ShowLight((PWMSt >> 10 & 0x1), lbXLedhi);   //灯光-反原点使能
            }
            else if (S2data.Axis == 1)
            {
                ShowLight((PWMSt >> 1 & 0x1), lbYLedbusy);  //灯光-忙
                ShowLight((PWMSt >> 3 & 0x1), lbYLedlimtp); //灯光-正极限
                ShowLight((PWMSt >> 4 & 0x1), lbYLedhome);  //灯光-原点
                ShowLight((PWMSt >> 5 & 0x1), lbYLedlimtn); //灯光-负极限
                ShowLight((PWMSt >> 6 & 0x1), lbYLedretu);  //灯光-回原点
                ShowLight((IOSt & 0x1), lbYLedpuls);        //灯光-脉冲
                ShowLight((IOSt & 0x2), lbYLeddire);        //灯光-方向

                ShowLight((PWMSt >> 7 & 0x1), lbYLedlimte); //灯光-极限使能
                ShowLight((PWMSt >> 8 & 0x1), lbYLedhe);    //灯光-原点使能
                ShowLight((PWMSt >> 9 & 0x1), lbYLedlimti); //灯光-反极限使能
                ShowLight((PWMSt >> 10 & 0x1), lbYLedhi);   //灯光-反原点使能
            }
            else
            {
                ShowLight((PWMSt >> 1 & 0x1), lbZLedbusy);  //灯光-忙
                ShowLight((PWMSt >> 3 & 0x1), lbZLedlimtp); //灯光-正极限
                ShowLight((PWMSt >> 4 & 0x1), lbZLedhome);  //灯光-原点
                ShowLight((PWMSt >> 5 & 0x1), lbZLedlimtn); //灯光-负极限
                ShowLight((PWMSt >> 6 & 0x1), lbZLedretu);  //灯光-回原点
                ShowLight((IOSt & 0x1), lbZLedpuls);        //灯光-脉冲
                ShowLight((IOSt & 0x2), lbZLeddire);        //灯光-方向

                ShowLight((PWMSt >> 7 & 0x1), lbZLedlimte); //灯光-极限使能
                ShowLight((PWMSt >> 8 & 0x1), lbZLedhe);    //灯光-原点使能
                ShowLight((PWMSt >> 9 & 0x1), lbZLedlimti); //灯光-反极限使能
                ShowLight((PWMSt >> 10 & 0x1), lbZLedhi);   //灯光-反原点使能
            }
        }