在運(yùn)動(dòng)控制中，軌跡執(zhí)行時(shí)間的預(yù)測(cè)對(duì)于多軸的協(xié)同、路徑預(yù)處理等方面有著重要的作用。CODESYS系列控制器提供了預(yù)測(cè)軌跡執(zhí)行時(shí)間功能塊。要實(shí)現(xiàn)完整的預(yù)測(cè)功能，需要使用到以下的功能塊。

SMC_SetForecast

這個(gè)功能塊專門用于為指定軸設(shè)定預(yù)測(cè)，其預(yù)測(cè)時(shí)長(zhǎng)被限定在最多512個(gè)任務(wù)周期。通過這種預(yù)測(cè)設(shè)置，用戶能夠預(yù)先獲取軸在未來特定時(shí)間點(diǎn)的狀態(tài)信息，包括：

持續(xù)時(shí)間預(yù)測(cè)：利用SMC_GetTravelTime功能，可以計(jì)算出軸到達(dá)某一特定位置所需的時(shí)間。

動(dòng)態(tài)信息獲取：通過SMC_ReadSetValues，能夠在特定時(shí)間點(diǎn)獲取軸的動(dòng)態(tài)信息。

預(yù)測(cè)時(shí)長(zhǎng)查詢：使用SMC_GetForecast可以讀取當(dāng)前的預(yù)測(cè)時(shí)長(zhǎng)。

SMC_GetForecast

該功能塊返回給定軸的預(yù)測(cè)時(shí)間，是由SMC_SetForecast 功能塊設(shè)置的。

SMC_GetTravelTime

此功能塊能夠預(yù)測(cè)軸到達(dá)指定位置所需的時(shí)間。

要獲取有效的時(shí)間預(yù)測(cè)，需要先通過SMC_SetForecast設(shè)置預(yù)測(cè)持續(xù)時(shí)間，確保軸在預(yù)測(cè)時(shí)間內(nèi)能到達(dá)指定位置。如果軸沒有移動(dòng)，即使它正好在指定位置，Valid也會(huì)顯示為FALSE。

SMC_ReadSetValues

該功能塊用于讀取軸的設(shè)定位置、速度、加速度和加加速度。允許設(shè)置一個(gè)正的時(shí)間偏移量（TimeOffset），以讀取未來的設(shè)定值。當(dāng)時(shí)間偏移量（TimeOffset）= 0時(shí)，將讀取當(dāng)前周期開始時(shí)的設(shè)定值。

程序示例

CASE state OF
STATE_POWER_DRIVE:    //軸使能
  mcp.Enable := TRUE;
  mcp.bDriveStart := TRUE;
  mcp.bRegulatorOn := TRUE;


  IF mcp.Status THEN
    state := STATE_SET_FORECAST;
  ELSIF mcp.Error THEN
    error := mcp.ErrorID;
    state := state + STATE_ERROR;  
  END_IF


STATE_SET_FORECAST:    //設(shè)置軌跡預(yù)測(cè)時(shí)長(zhǎng)
  setForecast.Execute := TRUE;
  setForecast.ForecastDuration := 0.3;  //0.3S


  getForecast.Enable := TRUE;


  IF setForecast.Done THEN
    state := STATE_MOVE_TO_POSITION;
  ELSIF setForecast.Error THEN
    error := setForecast.ErrorID;
    state := state + STATE_ERROR;  
  END_IF


STATE_MOVE_TO_POSITION:    //MC_MoveAbsolute
  ma.Execute := TRUE;
  ma.Position := 10;
  ma.Velocity := 20;
  ma.Acceleration := 200;
  ma.Deceleration := 200;
  ma.Jerk := 1000;


  timeToPosition.Enable := TRUE;
  timeToPosition.Position := 8;  //預(yù)測(cè)到達(dá)8時(shí)，所用的時(shí)間


  IF ma.Error THEN
    error := ma.ErrorID;
    state := state + STATE_ERROR;  
  END_IF
END_CASE


setForecast(Axis:= Drive);
getForecast(Axis:= Drive);


mcp(Axis:= Drive);
ma(Axis:= Drive);


timeToPosition(Axis:= Drive);
readSetValues(
  Axis:= Drive, 
  Enable:= timeToPosition.Valid, 
TimeOffset:=timeToPosition.Duration);

可通過采集到的波形圖觀察對(duì)于軌跡預(yù)測(cè)的效果。