Ejemplo n.º 1
0
        void SetSpeedCloseLoop(uint channel, uint speed)
        {
            CCoarseController.SA_SetClosedLoopMoveSpeed_S(mSystemIndex, channel, speed);
            if (speed > 18500)
            {
                speed = 18500;
            }
            if (speed < 50)
            {
                speed = 50;
            }

            mResult = CCoarseController.SA_SetClosedLoopMaxFrequency_S(mSystemIndex, channel, speed);
            if (mResult != CCoarseController.SA_OK)
            {
                //Initialize();
                MY_DEBUG("Setfrequency error!\n");
            }
        }