Optimize code
Merge branch 'dev' of github.com:bcosca/fatfree into dev