Port uCOS to atmega32u4 Init