本发明涉及一种基于simulink的四轴工具控制方法。所述四轴工具包括伸缩杆1、伸缩杆2、伸缩杆3、伸缩杆4、旋转主轴B和抛光头。根据四轴工具特点对simulink的控制程序进行优化，实现对抛光头的轨迹进行实时精密控制；包括改进PID控制和四轴工具系统运动控制；所述改进PID控制为对simulink中的PID控制部分进行逻辑改进，改进后的PID控制部分包括改进积分单元、选择单元和位移传感器反馈单元；所述四轴工具系统运动控制包括抛光工具系统运动反解、工具系统原点坐标求解和气动伸缩杆长度求解。