Bugfix
   * Fix IAR compiler warnings.
