Added new drawing code to PrimitiveBatch3D, added matrix transform to primitives