Nonlinear Model Predictive Controller (NMPC) implemented with the use of CasADi optimization framework and matlab simulation environment. Controller is able to avoid Static & Dynamic Obstacles also State and Control Constraints of UAV and gimbal was added to make problem realistic.