Implemented laser plane calculation

Needs to be tested