Merge pull request #20 from ipa-goa-sf/master

added sensor model
fixed frame ids
Merge pull request #3 from ipa-goa/master

visualization improvement
Merge remote branch 'goa/master'
fixed bug for fast segmentation