Renamed and rearranged some things for a proper collection of header
and implementation files that can be reused from other projects.
everything changed to full 3D (even the planar test robot)