Updated WatchDog code to protect motors & Legalised code