Camera app on stm32f4 using ChibiOS