A2伺服 – 運動中 重置坐標 的方法

位置坐標 是用來表示 伺服所在位置的,通常藉由 回原點 的方式來建立 坐標系,讓 坐標數值 與 機械的位置 連結起來!但有時需要在伺服運動中 改變當前的 坐標數值,不能採用 回原點方式,以免打斷當前的命令!本文提供一種 “運動中 瞬間改變 坐標值 的方法“,供大家參考:

作法是利用 高速抓取,將 DI7:CAP 發生瞬間的 位置坐標 改成 P5-76 的值,功能特徵如下:

  • 任何模式(P1-01=?)皆可使用
  • CAP 高速抓取 反應即時(< 5 us),精度高!
  • 一段距離就 重建 坐標系,可避免 坐標溢位。
  • 是隱藏版的 回原點功能!

作法 步驟如下:

  1. 參數初始化(只需設定一次):
    • P2-16=0:關閉 DI7 預設的極限功能,避免跳 AL.015
    • P1-19.X=0:關閉CAP循環模式
  2. 開啟 CAP 功能,動態修改 坐標值
    • 設定 P5-38 =1:抓取 1 點即可,注意此時 P5-39.X 必須=0,否則無法寫入 P5-38.
    • 設定 P5-76 = 坐標重置的 目標值
    • 設定 P5-39=0x2033,開啟 CAP 功能,並設定 抓取的第一點坐標重置。

設定完成,就可以讓伺服運轉(任何模式皆可),當 DI7 上升緣發生時,就會把當時的坐標 瞬間改成 P5-76,並且不影響當時的伺服命令! 伺服的位置坐標可由 監視變數 V000 觀察到,實際的結果如下圖所示:

高速抓取重置坐標系示波器圖形

  • CH1:為 馬達回授 的 位置坐標(PUU)
  • CH2:為 DI 狀態,圖中 B 點處 DI 7:Off => ON,CAP 抓取發生!
  • CH3:為 馬達當時速度(r/min),不受坐標改變的影響.

當馬達由 A點 開始加速時,位置坐標 CH1 也開始增加,到達 B點 時,由於 DI7 Off => ON ,高速抓取發生,就把CH1 位置坐標瞬間修改成 P5-76(設定值是100000),但是不影響當時執行的命令,馬達速度 CH3 仍然不變!

CAP 抓取功能重置

一旦抓取成功後,CAP 功能就關閉了(P5-39.X0=0),且 P5-38 也變成 0,若要再次執行抓取,只需要重複 前述 步驟 2 即可!

PR/CANopen pp 模式 命令終點 也被重置

PR 模式CANopen profile position 模式下,當 CAP 把位置坐標 修改成 P5-76 後,PR 的 命令終點 也會改到 P5-76 處,換言之,此時下達 PR 增量0 的命令就會 定位到 CAP 發生的位置,需特別注意!絕對定位命令 也會以新建立的坐標為準!

在某些應用,坐標 必須根據 加工物 出現的位置 重新定義,便適用此種方法。每次 CAP 後,坐標 P5-76 都會 連結到 產品出現的位置,除了方便計算 後續的命令以外,也避免了坐標系 的溢位問題,對於 無限行程的機構應用 很有幫助!

參考:直線與分度坐標PR 絕對/增量/相對/CAP 命令回原點常見問題


 

發表迴響