In this paper, we presented a new algebraic iterative algorithm for the optimal control of the nonlinear systems. The algorithm is based on two steps. The first step transforms nonlinear optimal control problem into a sequence of linear optimal control problem using the quasilinearization method. In the second step, TPBCP(two point boundary condition problem) is solved by algebraic equations instead of differential equations using the new integral operational matrix of BPF(block pulse functions). The proposed algorithm is simple and efficient in computation for the optimal control of nonlinear systems and is less error value than that by the conventional matrix. In computer simulation, the algorithm was verified through the optimal control design of synchronous machine connected to an infinite bus.