The extract plane function is working. The extract ground function is almost finished