一种塔尺/棱镜杆竖向自稳控制装置及控制方法
摘要:
塔尺/棱镜杆竖向自稳控制装置及方法,装置中三级动臂通过转接机构与夹具连接,二级动臂通过一个X轴转动关节与三级动臂连接、X轴伺服电机内置于该X轴转动关节,一级动臂通过Z轴转动关节与二级动臂连接、Z轴伺服电机内置于该Z轴转动关节,手持握杆通过另一个X轴转动关节与一级动臂连接,传感器安装在夹具上。方法包括S1:采样T(i)时刻的姿态倾角θx(i)、θz(i);S2:计算姿态偏差Ex(i)、Ez(i);S3:进行PID计算;得出补偿角度信号Ox(i)、Oz(i)。S4:X轴伺服电机和Z轴伺服电机执行补偿动作。具有结构简单可靠、响应速度快、执行效率高、自动化程度高、可减轻人工扶尺的劳动强度的优点。
0/0