Updated depth2cloud model, world frame measurement model
Merge pull request #1 from notAlex2/master

Updated depth2cloud model, world frame measurement model