Partial, tentative fix to https://github.com/tork-a/openrtm_tutorial/issues/5. 

More commits should happen to fully address the issue.