Finish Wdog driver

and test code, seem wdog cannot enter isr