sense_establishment.c

来自「伺服控制器主要用于电动执行器的控制 在工业方面大量应用」· C语言 代码 · 共 35 行

void sense_Establishment()                   //灵敏度调整程序段
{
/*************死区调整程序段***************/
  unsigned char S1=0;
  S1 = P1IN;          //P1.0~P1.3口选择
  S1 &= 0x0E;       //强制将中间变量的高4位与最后一位置0，便于计算
  
  switch(S1)
  {
  case 0:{value = 6;}break;    //第一档死区
  case 2:{value = 8;}break;    //第二档死区
  case 4:{value = 10;}break;    //第三档死区
  case 6:{value = 12;}break;    //第四档死区(死区出厂默认值)
  case 8:{value = 15;}break;    //第五档死区
  case 10:{value = 20;}break;    //第六档死区
  case 12:{value = 25;}break;    //第七档死区
  case 14:{value = 30;}break;    //第八档死区
  default:{value = 12;}
  }
  
  if((key_close1 == 0xFF)||(key_close == 0xFF))          //按键确认死区调整值
  {
    flash = 0xFF;
    sense_RAM = value;          //调整RAM内容
    FLASH_DATA[0] = value;      //调整flash参数  用于调整存于flash的内容  6
    P2OUT =0x03;  //D1、D2亮
  }
  else
  {
    P2OUT &=0xFE;  //D1灭
    P2OUT &=0xFD;  //D2灭
  }
}