Updated ChibiOS-RT
Changed counts back to 5000 since old motor came back.