Stability and Trajectory Control for Post-Impact Vehicle Based on Fuzzy PID Algorithm