Merge pull request #2 from ipa320/groovy_dev

fixes for example package
add diagnostics
Merge pull request #28 from thiagodefreitas/groovy_dev

Launch file changes after hardware test