hso.txt

运用模糊算法和PID调节控制开关磁阻电机的调速。采用的单片机是Intel的80c196KB,编程语言为PL/M.

/*高速输出处理程序*/
HSO_PROCESS:PROCEDURE ;/*两相定角度开通角-7.5，关断角22.5*/
  DISABLE;
  IF DIRECT=1 THEN DO;/*逆时针*/
TURNON=T_SPAN/2;
TURNOFF=T_SPAN/2;
DO CASE ORDER;
T00:DO;/*P=1，Q=0*//*P+*/
  HSO_COMMAND=21H;
  HSO_TIME=TIMER1+TURNON;
  R0=0;
  R0=0;
  HSO_COMMAND=03H;
  HSO_TIME=TIMER1+TURNOFF;
  R0=0;
  R0=0;
 END;
TO1:DO;/*P=1,Q=1*//*Q+*/
  HSO_COMMAND=22H;
  HSO_TIME=TIMER1+TURNON;
  R0=0;
  R0=0;
  HSO_COMMAND=00H;
  HSO_TIME=TIMER1+TURNOFF;
  R0=0;
  R0=0;
 END;
TO2:DO;/*P=0,Q=1*//*P-*/
  HSO_COMMAND=23H;
  HSO_TIME=TIMER1+TURNON;
  R0=0;
  R0=0;
  HSO_COMMAND=01H;
  HSO_TIME=TIMER1+TURNOFF;
  R0=0;
  R0=0;
 END;
TO3:DO;/*P=0,Q=0*//*Q-*/
  HSO_COMMAND=20H;
  HSO_TIME=TIMER1+TURNON;
  R0=0;
  R0=0;
  HSO_COMMAND=02H;
  HSO_TIME=TIMER1+TURNOFF;
  R0=0;
  R0=0;
 END;
END;
END;
ELSE DO;/*顺时针*/
TURNON=T_SPAN/2;
TURNOFF=T_SPAN/2;
DO CASE ORDER;
T10:DO;/*P=1,Q=1*//*P+*/
  HSO_COMMAND=21H;
  HSO_TIME=TIMER1+TURNON;
  R0=0;
  R0=0;
  HSO_COMMAND=03H;
  HSO_TIME=TIMER1+TURNOFF;
  R0=0;
  R0=0;
 END;
T11:DO;/*P=0,Q=1*/
  HSO_COMMAND=22H;
  HSO_TIME=TIMER1+TURNON;
  R0=0;
  R0=0;
  HSO_COMMAND=00H;
  HSO_TIME=TIMER1+TURNOFF;
  R0=0;
  R0=0;
 END;
T12:DO;/*P=0,Q=0*/
  HSO_COMMAND=23H;
  HSO_TIME=TIMER1+TURNON;
  R0=0;
  R0=0;
  HSO_COMMAND=01H;
  HSO_TIME=TIMER1+TURNOFF;
  R0=0;
  R0=0;
 END;
T13:DO;/*P=1,Q=0*/
  HSO_COMMAND=20H;
  HSO_TIME=TIMER1+TURNON;
  R0=0;
  R0=0;
  HSO_COMMAND=02H;
  HSO_TIME=TIMER1+TURNOFF;
  R0=0;
  R0=0;
 END;
END;
END;
  ENABLE;
END HSO_PROCESS;