完成完成PID兩軸部份控制及邊界函式