工作任務是轉兩個木螺絲，要求邊轉邊前進，兩邊各有一個扭矩傳感器。要求木螺絲用兩軸控制一軸旋轉一軸前進，兩邊的前進距離和扭矩都有一個范圍，要求兩邊停止時扭矩和前進距離都在范圍內，兩邊對應的角度也要大致相同（也就是停止時兩邊轉的角度相加是360度）。目前想法是旋轉和前進用直線插補，有一邊前進距離扭矩固定，另外一邊距離和扭矩到范圍時角度達到立即停止輸出，求大神指點

木頭螺絲沒打過，，金屬螺絲倒是打過，直接選用帶扭力反饋的電批，，上下方向一般用氣缸加彈簧的結構，，，，不知道能不能幫到你