Added setting coordinates using a defined rigid body tool
Add plane objects to world
Remove defining coordinate frame for data points