Merge pull request #6 from RoboGroup3/master

update my code
 Image extracted from the Point cloud
Merged
Merge branch 'RoboGroup3-master'
 Merge
Merge branch 'Stinktier-master'