Update to 3D

* add grid
* add helper lines for 3D positions