Declare fill_pos outside the FOR

Hi Dean,
when work on a compiler not C99 you receive
"GCC error: 'for' loop initial declaration used outside C99 mode"

whit this modification it work with new and old compiler.
Example it is necessary when using VisualMicro plugin on AtmelStudio