Added IAR project, code updated a bit