Merge pull request #1 from ipa320/develop

update from 320
fix loop rate
Merge remote-tracking branch 'origin/fix/loop_rate' into develop
cleanup cpp templates (tabs vs spaces)