The MPC (Model Predictive Control) is one of the techniques that can be used to control an unmanned vehicle. It predicts the future vehicle trajectory using the dynamic characteristic of the vehicle and generate the control value to track the reference path. If some obstacles are detected on the reference paths, the MPC can generate control value to avoid the obstacles imposing the inequality constraints on the MPC cost function. In this paper, we propose an obstacle modeling algorithm for MPC with inequality constraints for obstacle avoidance and a method to set selective constraint on the MPC for stable obstacle avoidance. Simulations with the field test data show successful obstacle avoidance and way point tracking performance.