acquiesce.c

伺服控制器主要用于电动执行器的控制 在工业方面大量应用

void acquiesce()
{
  if((key_open == 0xFF)||(key_open1 == 0xFF)||(key_close == 0xFF)||(key_close1 == 0xFF))
  {
    unsigned char FLASH_DATA_TEMP[N_Data] = {0x0C,0x09,0x3E,0x5C,0xBC,0x03,0xF2,0x76,0x76,0x00,0x14,
    0x0B,0x5E};
    for(int i=0;i<N_Data;i++)
      FLASH_DATA[i] = FLASH_DATA_TEMP[i];
    FLASH_Operation();            //写flash操作
    /***************初始化相关控制参数*******************/
    sense_RAM = 12;                 //灵敏度默认为1.2%
    value = sense_RAM;
    
    Nf_min = 2566;                   //初始化反馈输入最小值
    Nf_max = 22000;                  //初始化反馈输入最大值  
    
    Ng_min = 1010;                   //初始化给定输入最小值
    Ng_max = 30326;                  //初始化给定输入最大值
    
    out_min = 20;                    //反馈信号输出最小值
    OUT_0V = out_min;
    out_max = 2910;                  //反馈信号输出最大值
    OUT_10V = out_max; 
    
    P2OUT =0x03;  //D1、D2亮
  }
  else
  {
    P2OUT &=0xFE;  //D1灭
    P2OUT &=0xFD;  //D2灭
  }
}