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