Fixed warnings and removed TODO
Merge pull request #93 from andersforsell/trackball_cleanup

Fixed warnings and removed TODO