Merge pull request #1 from ipa320/develop

update from 320
fix loop rate
Merge pull request #27 from ipa-fmw/fix/loop_rate

Fix/loop rate