P0402 is related to the DPFE sensor, exsessive egr flow at idle, I had this issue last summer and there is a good thread on it if you search for it
but do check the egr valve first, when you apply vacuum and the idle stumbles the valve is fine so it will be the DPFE sensor