Add to RK4 Formula