Math3D class added, new coords plotting moved to it from ShipDrive class