hexathird's fix
Merge branch 'naze32' of https://github.com/SVentas/TauLabs into naze32