3D trajectory based on matlab proportional guidance