General code improvements

Use where possible final modifiers, for each loops, (un)boxing only if needed, etc.