1。電機(jī)是用CPU173運(yùn)動(dòng)模塊控制,放卷電機(jī)有減速機(jī)1比5,每轉(zhuǎn)角度是72度。
2。已知放卷半徑為105mm.我想讓放卷電機(jī)放卷時(shí)感應(yīng)感應(yīng)器后走30mm行程怎樣寫(xiě)ST程序。
3。公式求圓弧長(zhǎng)度: 2*3.14*半徑*角度/360。
每轉(zhuǎn)脈沖4194304 / 72度=58254.2 pus/deg
圓弧長(zhǎng)度:2*3.14*105*15deg(角度值可通過(guò)當(dāng)前脈沖量讀取轉(zhuǎn)換成角度) /360=27.475mm
控制要求:放卷電機(jī)放卷過(guò)程中收到 感應(yīng)器信號(hào)后計(jì)算放卷電機(jī)走了多少mm.因?yàn)橛懈↑c(diǎn)運(yùn)算想用ST語(yǔ)言寫(xiě),但沒(méi)有寫(xiě)過(guò),求大神支招!
電機(jī)設(shè)置
ST1
ST2