We develop an optimization algorithm in order to improve the nonlinear optimal robust controller for diesel engine which equipped by Exhaust Gas Recirculation and Variable Geometry Turbocharger systems. For this goal we present a new way to search the optimal shape of control Lyapunov function which permits to calculate the parameters to achieve stabilization and optimal control criteria. The idea is to verify different form of Lyapunov functions in order to desire better performance.