Code for ChibsOS and Discovery board