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