Added tests to work with planes
Add functionalities in the cpp