Added plane support for G02/G03
- sorted includes, now each file can be compiled independently
- fixed a few compiler warnings