Added Motor Beep when ready or inititalized
Bug fixes on Stop PID, Added Shutdown functionnlaity