一根木頭碰到開關(guān)
記錄目標位置(伺服的絕對位置)至最后一筆,總記錄數(shù)目加1
記錄不為空? (總記錄數(shù)目不為零)
是:移動到第一筆目標位置
是否移到動目標位置?
是:將 n+1 筆移動到 n 筆 (往前移一格),總記錄數(shù)目減1,定位完畢。
否:伺服繼續(xù)移動
這樣有木頭碰到時就會新增一筆伺服要定位的絕對位置在記錄最后一筆。
每一筆完成后,看下一筆記錄來計算要移動的長度。
這種做法較為簡單,但要注意整數(shù)溢位問題。不然就要找特定機會將位置規(guī)零。
若使用相對位置,計算雖然復(fù)雜一點,但可以避免溢位問題。