/*
-----------------------------------------------------------------------------
This source file is part of mogre-procedural
For the latest info, see http://code.google.com/p/mogre-procedural/
my blog:http://hi.baidu.com/rainssoft
this is overwrite  ogre-procedural c++ project using c#, look  ogre-procedural c++ source http://code.google.com/p/ogre-procedural/
   
Copyright (c) 2013-2020 rains soft

Permission is hereby granted, free of charge, to any person obtaining a copy
of this software and associated documentation files (the "Software"), to deal
in the Software without restriction, including without limitation the rights
to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
copies of the Software, and to permit persons to whom the Software is
furnished to do so, subject to the following conditions:

The above copyright notice and this permission notice shall be included in
all copies or substantial portions of the Software.

THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
THE SOFTWARE.
-----------------------------------------------------------------------------
*/

//#ifndef PROCEDURAL_EXTRUDER_INCLUDED
#define PROCEDURAL_EXTRUDER_INCLUDED


//write with new std.... ok
namespace Mogre_Procedural
{
    using System;
    using System.Collections.Generic;
    using System.Text;

    using Mogre;
    using Math = Mogre.Math;
    using Mogre_Procedural.std;
    using TrackMap = Mogre_Procedural.std.std_map<uint, Mogre_Procedural.Track>;


    //*
    // * Extrudes a 2D shape along a path to build an extruded mesh.
    // * Can be used to build things such as pipelines, roads...
    // * <table border="0" width="100%"><tr><td>\image html extruder_generic.png "Generic extrusion"</td>
    // * <td>\image html extruder_rotationtrack.png "Extrusion with rotation track"</td></tr>
    // * <tr><td>\image html extruder_scaletrack.png "Extrusion with scale track"</td>
    // * <td>\image html extruder_texturetrack.png "Extrusion with texture track"</td></tr>
    // * <tr><td>\image html extruder_multishape.png "Multishape extrusion"</td><td>&nbsp;</td></tr></table>
    // * \note Concerning UV texCoords, U is along the path and V along the shape.
    // 
    //C++ TO C# CONVERTER WARNING: The original type declaration contained unconverted modifiers:
    //ORIGINAL LINE: class _ProceduralExport Extruder : public MeshGenerator<Extruder>
    /// <summary>
    ///  ѹ ѹ 
    /// </summary>
    public class Extruder : MeshGenerator<Extruder>
    {
        private MultiShape mMultiShapeToExtrude = new MultiShape();
        private MultiPath mMultiExtrusionPath = new MultiPath();
        private bool mCapped;

        private TrackMap mRotationTracks = new std_map<uint, Track>();
        private TrackMap mScaleTracks = new std_map<uint, Track>();
        private TrackMap mShapeTextureTracks = new std_map<uint, Track>();
        private TrackMap mPathTextureTracks = new std_map<uint, Track>();

        /// Default constructor
        public Extruder() {
            mCapped = true;
        }
        public Extruder(bool capped) {
            mCapped = capped;
        }

        //    *
        //	 * Builds the mesh into the given TriangleBuffer
        //	 * @param buffer The TriangleBuffer on where to append the mesh.
        //	 * @exception Ogre::InvalidStateException Either shape or multishape must be defined!
        //	 * @exception Ogre::InvalidStateException Required parameter is zero!
        //	 
        //-----------------------------------------------------------------------
        //
        //ORIGINAL LINE: void addToTriangleBuffer(TriangleBuffer& buffer) const
        public override void addToTriangleBuffer(ref TriangleBuffer buffer) {
            if (mMultiShapeToExtrude.getShapeCount() == 0)
                OGRE_EXCEPT("Ogre::Exception::ERR_INVALID_STATE", "At least one shape must be defined!", "Procedural::Extruder::addToTriangleBuffer(Procedural::TriangleBuffer)");
            ;

            // Triangulate the begin and end caps
            if (mCapped && mMultiShapeToExtrude.isClosed()) {
                GlobalMembers._extrudeCapImpl(ref buffer, mMultiShapeToExtrude, mMultiExtrusionPath, mScaleTracks, mRotationTracks);
            }

            // Extrude the paths contained in multiExtrusionPath
            for (uint j = 0; j < mMultiExtrusionPath.getPathCount(); ++j) {
                Path extrusionPath = mMultiExtrusionPath.getPath((int)j);
                Track rotationTrack = null;
                if (mRotationTracks.find(j) != -1) {// mRotationTracks.end()) {
                    rotationTrack = mRotationTracks[j];//mRotationTracks.find(j).second;
                    extrusionPath = extrusionPath.mergeKeysWithTrack(mRotationTracks[j]);// (*mRotationTracks.find(j).second);
                }
                Track scaleTrack = null;
                if (mScaleTracks.find(j) != -1) {// mScaleTracks.end()) {
                    rotationTrack = mScaleTracks[j];//mScaleTracks.find(j).second;
                    extrusionPath = extrusionPath.mergeKeysWithTrack(mScaleTracks[j]);// (*mScaleTracks.find(j).second);
                }
                Track pathTextureTrack = null;
                if (mPathTextureTracks.find(j) != -1) {// mPathTextureTracks.end()) {
                    pathTextureTrack = mPathTextureTracks[j]; //mPathTextureTracks.find(j).second;
                    extrusionPath = extrusionPath.mergeKeysWithTrack(mPathTextureTracks[j]);//(*mPathTextureTracks.find(j).second);
                }

                std_vector<std_pair<uint, uint>> segs = mMultiExtrusionPath.getNoIntersectionParts(j);

                //for (List<std.pair<uint, uint>>.Enumerator it = segs.GetEnumerator(); it.MoveNext(); ++it) {
                foreach (var it in segs) {
                    for (uint i = 0; i < mMultiShapeToExtrude.getShapeCount(); i++) {
                        Shape shapeToExtrude = mMultiShapeToExtrude.getShape(i);
                        Track shapeTextureTrack = null;
                        if (mShapeTextureTracks.find(i) != -1) {// mShapeTextureTracks.end()) {
                            shapeTextureTrack = mShapeTextureTracks[i]; //mShapeTextureTracks.find(i).second;
                            shapeToExtrude.mergeKeysWithTrack(shapeTextureTrack);
                        }
                        GlobalMembers._extrudeBodyImpl(ref buffer, shapeToExtrude, extrusionPath, (int)it.first, (int)it.second, shapeTextureTrack, rotationTrack, scaleTrack, pathTextureTrack);
                    }
                }

                // Make the intersections
                //typedef std::vector<PathCoordinate> PathIntersection;
                std_vector<std_vector<MultiPath.PathCoordinate>> intersections = mMultiExtrusionPath.getIntersections();
                //for (List<MultiPath.PathIntersection>.Enumerator it = intersections.GetEnumerator(); it.MoveNext(); ++it) {
                foreach (var it in intersections) {
                    for (uint i = 0; i < mMultiShapeToExtrude.getShapeCount(); i++) {
                        Track shapeTextureTrack = null;
                        if (mShapeTextureTracks.find(i) != -1)// mShapeTextureTracks.end())
                            shapeTextureTrack = mShapeTextureTracks[i];//mShapeTextureTracks.find(i).second;
                        GlobalMembers._extrudeIntersectionImpl(ref buffer, it, mMultiExtrusionPath, mMultiShapeToExtrude.getShape(i), shapeTextureTrack);
                    }
                }
            }
        }



        //* Sets the shape to extrude. Mutually exclusive with setMultiShapeToExtrude. 
        public Extruder setShapeToExtrude(Shape shapeToExtrude) {
            mMultiShapeToExtrude.clear();
            mMultiShapeToExtrude.addShape(shapeToExtrude);
            return this;
        }

        //* Sets the multishape to extrude. Mutually exclusive with setShapeToExtrude. 
        public Extruder setMultiShapeToExtrude(MultiShape multiShapeToExtrude) {
            mMultiShapeToExtrude.clear();
            mMultiShapeToExtrude.addMultiShape(multiShapeToExtrude);
            return this;
        }

        //* Sets the extrusion path 
        public Extruder setExtrusionPath(Path extrusionPath) {
            mMultiExtrusionPath.clear();
            mMultiExtrusionPath.addPath(extrusionPath);
            mMultiExtrusionPath._calcIntersections();
            return this;
        }

        //* Sets the extrusion multipath 
        public Extruder setExtrusionPath(MultiPath multiExtrusionPath) {
            mMultiExtrusionPath.clear();
            mMultiExtrusionPath.addMultiPath(multiExtrusionPath);
            mMultiExtrusionPath._calcIntersections();
            return this;
        }

        //* Sets the rotation track (optional) 
        public Extruder setRotationTrack(Track rotationTrack) {
            return setRotationTrack(rotationTrack, 0);
        }
        //
        //ORIGINAL LINE: inline Extruder& setRotationTrack(const Track* rotationTrack, uint index = 0)
        public Extruder setRotationTrack(Track rotationTrack, uint index) {
            if (rotationTrack == null && mRotationTracks.find(index) != -1)// mRotationTracks.end())
                mRotationTracks.erase(mRotationTracks.find(index), true);
            if (rotationTrack != null) {
                mRotationTracks[index] = rotationTrack;
            }
            return this;
        }

        //* Sets the scale track (optional) 
        public Extruder setScaleTrack(Track scaleTrack) {
            return setScaleTrack(scaleTrack, 0);
        }
        //
        //ORIGINAL LINE: inline Extruder& setScaleTrack(const Track* scaleTrack, uint index = 0)
        public Extruder setScaleTrack(Track scaleTrack, uint index) {
            if (scaleTrack == null && mScaleTracks.find(index) != -1)// mScaleTracks.end())
                mRotationTracks.erase(mScaleTracks.find(index), true);
            if (scaleTrack != null)
                mScaleTracks[index] = scaleTrack;
            return this;
        }

        /// Sets the track that maps shape points to V texture coords (optional).
        /// Warning : if used with multishape, all shapes will have the same track.
        public Extruder setShapeTextureTrack(Track shapeTextureTrack) {
            return setShapeTextureTrack(shapeTextureTrack, 0);
        }
        //
        //ORIGINAL LINE: inline Extruder& setShapeTextureTrack(const Track* shapeTextureTrack, uint index = 0)
        public Extruder setShapeTextureTrack(Track shapeTextureTrack, uint index) {
            if (shapeTextureTrack == null && mShapeTextureTracks.find(index) != -1)// mShapeTextureTracks.end())
                mShapeTextureTracks.erase(mShapeTextureTracks.find(index), true);
            if (shapeTextureTrack != null)
                mShapeTextureTracks[index] = shapeTextureTrack;
            return this;
        }

        /// Sets the track that maps path points to V texture coord (optional).
        public Extruder setPathTextureTrack(Track pathTextureTrack) {
            return setPathTextureTrack(pathTextureTrack, 0);
        }
        //
        //ORIGINAL LINE: inline Extruder& setPathTextureTrack(const Track* pathTextureTrack, uint index = 0)
        public Extruder setPathTextureTrack(Track pathTextureTrack, uint index) {
            if (pathTextureTrack == null && mPathTextureTracks.find(index) != -1)// mPathTextureTracks.end())
                mPathTextureTracks.erase(mPathTextureTracks.find(index), true);
            if (pathTextureTrack != null)
                mPathTextureTracks[index] = pathTextureTrack;
            return this;
        }

        //* Sets whether caps are added to the extremities or not (not closed paths only) 
        public Extruder setCapped(bool capped) {
            mCapped = capped;
            return this;
        }
    }




    public static partial class GlobalMembers
    {
        //-----------------------------------------------------------------------
        public static void _extrudeShape(ref TriangleBuffer buffer, Shape shape, Vector3 position, Quaternion orientationLeft, Quaternion orientationRight, float scale, float scaleCorrectionLeft, float scaleCorrectionRight, float totalShapeLength, float uTexCoord, bool joinToTheNextSection, Track shapeTextureTrack) {
            float lineicShapePos = 0.0f;
            int numSegShape = shape.getSegCount();
            // Insert new points
            for (uint j = 0; j <= numSegShape; ++j) {
                Vector2 vp2 = shape.getPoint((int)j);
                Quaternion orientation = (vp2.x > 0) ? orientationRight : orientationLeft;
                Vector2 vp2normal = shape.getAvgNormal(j);
                Vector3 vp = new Vector3();
                if (vp2.x > 0)
                    vp = new Vector3(scaleCorrectionRight * vp2.x, vp2.y, 0);
                else
                    vp = new Vector3(scaleCorrectionLeft * vp2.x, vp2.y, 0);
                Vector3 normal = new Vector3(vp2normal.x, vp2normal.y, 0);
                buffer.rebaseOffset();
                Vector3 newPoint = position + orientation * (scale * vp);
                if (j > 0)
                    lineicShapePos += (vp2 - shape.getPoint((int)j - 1)).Length;
                float vTexCoord = 0f;
                if (shapeTextureTrack != null)
                    vTexCoord = shapeTextureTrack.getValue(lineicShapePos, lineicShapePos / totalShapeLength, j);
                else
                    vTexCoord = lineicShapePos / totalShapeLength;

                buffer.vertex(newPoint, orientation * normal, new Vector2(uTexCoord, vTexCoord));

                if (j < numSegShape && joinToTheNextSection) {
                    if (shape.getOutSide() == Side.SIDE_LEFT) {
                        buffer.triangle(numSegShape + 1, numSegShape + 2, 0);
                        buffer.triangle(0, numSegShape + 2, 1);
                    }
                    else {
                        buffer.triangle(numSegShape + 2, numSegShape + 1, 0);
                        buffer.triangle(numSegShape + 2, 0, 1);
                    }
                }
            }
        }
        //-----------------------------------------------------------------------
        public static void _extrudeBodyImpl(ref TriangleBuffer buffer, Shape shapeToExtrude, Path pathToExtrude, int pathBeginIndex, int pathEndIndex, Track shapeTextureTrack, Track rotationTrack, Track scaleTrack, Track pathTextureTrack) {
            if (pathToExtrude == null || shapeToExtrude == null)
                OGRE_EXCEPT("Ogre::Exception::ERR_INVALID_STATE", "Shape and Path must not be null!", "Procedural::Extruder::_extrudeBodyImpl(Procedural::TriangleBuffer&, const Procedural::Shape*)");
            ;

            uint numSegPath = (uint)(pathEndIndex - pathBeginIndex);
            uint numSegShape = (uint)shapeToExtrude.getSegCount();

            if (numSegPath == 0 || numSegShape == 0)
                OGRE_EXCEPT("Ogre::Exception::ERR_INVALID_STATE", "Shape and path must contain at least two points", "Procedural::Extruder::_extrudeBodyImpl(Procedural::TriangleBuffer&, const Procedural::Shape*)");
            ;

            float totalPathLength = pathToExtrude.getTotalLength();
            float totalShapeLength = shapeToExtrude.getTotalLength();

            // Merge shape and path with tracks
            float lineicPos = pathToExtrude.getLengthAtPoint(pathBeginIndex);
            Path path = pathToExtrude;
            numSegPath = (uint)(pathEndIndex - pathBeginIndex);
            numSegShape = (uint)shapeToExtrude.getSegCount();

            // Estimate vertex and index count
            buffer.rebaseOffset();
            buffer.estimateIndexCount(numSegShape * numSegPath * 6);
            buffer.estimateVertexCount((numSegShape + 1) * (numSegPath + 1));

            Vector3 oldup = new Vector3();
            for (int i = pathBeginIndex; i <= pathEndIndex; ++i) {
                Vector3 v0 = path.getPoint(i);
                Vector3 direction = path.getAvgDirection(i);

                Quaternion q = Utils._computeQuaternion(direction);

                Radian angle = Utils.angleBetween((q * Vector3.UNIT_Y), (oldup));
                if (i > pathBeginIndex && angle > (Radian)Math.HALF_PI / 2.0f) {
                    q = Utils._computeQuaternion(direction, oldup);
                }
                oldup = q * Vector3.UNIT_Y;

                float scale = 1.0f;

                if (i > pathBeginIndex)
                    lineicPos += (v0 - path.getPoint(i - 1)).Length;

                // Get the values of angle and scale
                if (rotationTrack != null) {
                    float angle_2 = 0f;
                    angle_2 = rotationTrack.getValue(lineicPos, lineicPos / totalPathLength, (uint)i);

                    q = q * new Quaternion((Radian)angle_2, Vector3.UNIT_Z);
                }
                if (scaleTrack != null) {
                    scale = scaleTrack.getValue(lineicPos, lineicPos / totalPathLength, (uint)i);
                }
                float uTexCoord = 0f;
                if (pathTextureTrack != null)
                    uTexCoord = pathTextureTrack.getValue(lineicPos, lineicPos / totalPathLength, (uint)i);
                else
                    uTexCoord = lineicPos / totalPathLength;

                _extrudeShape(ref buffer, shapeToExtrude, v0, q, q, scale, 1.0f, 1.0f, totalShapeLength, uTexCoord, i < pathEndIndex, shapeTextureTrack);
            }
        }

        private static void OGRE_EXCEPT(string p, string p_2, string p_3) {
            throw new Exception(p + "_" + p_2 + "_" + p_3);
        }
        //-----------------------------------------------------------------------
        public static void _extrudeCapImpl(ref TriangleBuffer buffer, MultiShape multiShapeToExtrude, MultiPath extrusionMultiPath, TrackMap scaleTracks, TrackMap rotationTracks) {
            std_vector<int> indexBuffer = new std_vector<int>();
            // PointList pointList;
            std_vector<Vector2> pointList = new std_vector<Vector2>();

            Triangulator t = new Triangulator();
            t.setMultiShapeToTriangulate(multiShapeToExtrude);
            t.triangulate(indexBuffer, pointList);

            for (uint i = 0; i < extrusionMultiPath.getPathCount(); ++i) {
                Path extrusionPath = extrusionMultiPath.getPath((int)i);
                Track scaleTrack = null;
                Track rotationTrack = null;
                if (scaleTracks.find(i) != -1)// scaleTracks.end())
                    scaleTrack = scaleTracks[i];//.find(i).second;
                if (rotationTracks.find(i) != -1)// rotationTracks.end())
                    rotationTrack = rotationTracks[i];//.find(i).second;

                //begin cap
                //if (extrusionMultiPath.getIntersectionsMap().find(MultiPath.PathCoordinate(i, 0)) == extrusionMultiPath.getIntersectionsMap().end())
                if (extrusionMultiPath.getIntersectionsMap().find(new MultiPath.PathCoordinate(i, 0)) == -1) {
                    buffer.rebaseOffset();
                    buffer.estimateIndexCount((uint)indexBuffer.Count);
                    buffer.estimateVertexCount((uint)pointList.Count);

                    Quaternion qBegin = Utils._computeQuaternion(extrusionPath.getDirectionAfter(0));
                    if (rotationTrack != null) {
                        float angle = rotationTrack.getFirstValue();
                        qBegin = qBegin * new Quaternion((Radian)angle, Vector3.UNIT_Z);
                    }
                    float scaleBegin = 1.0f;
                    if (scaleTrack != null)
                        scaleBegin = scaleTrack.getFirstValue();

                    for (int j = 0; j < pointList.size(); j++) {
                        Vector2 vp2 = pointList[j];
                        Vector3 vp = new Vector3(vp2.x, vp2.y, 0);
                        Vector3 normal = -Vector3.UNIT_Z;

                        Vector3 newPoint = extrusionPath.getPoint(0) + qBegin * (scaleBegin * vp);
                        buffer.vertex(newPoint, qBegin * normal, vp2);
                    }
                    for (int i2 = 0; i2 < indexBuffer.Count / 3; i2++) {
                        buffer.index(indexBuffer[i2 * 3]);
                        buffer.index(indexBuffer[i2 * 3 + 2]);
                        buffer.index(indexBuffer[i2 * 3 + 1]);
                    }
                }

                //end cap
                //if (extrusionMultiPath.getIntersectionsMap().find(MultiPath.PathCoordinate(i, extrusionPath.getSegCount())) == extrusionMultiPath.getIntersectionsMap().end())
                if (extrusionMultiPath.getIntersectionsMap().find(new MultiPath.PathCoordinate(i, (uint)extrusionPath.getSegCount())) == -1) {
                    buffer.rebaseOffset();
                    buffer.estimateIndexCount((uint)indexBuffer.Count);
                    buffer.estimateVertexCount((uint)pointList.Count);

                    Quaternion qEnd = Utils._computeQuaternion(extrusionPath.getDirectionBefore(extrusionPath.getSegCount()));
                    if (rotationTrack != null) {
                        float angle = rotationTrack.getLastValue();
                        qEnd = qEnd * new Quaternion((Radian)angle, Vector3.UNIT_Z);
                    }
                    float scaleEnd = 1.0f;
                    if (scaleTrack != null)
                        scaleEnd = scaleTrack.getLastValue();

                    for (int j = 0; j < pointList.Count; j++) {
                        Vector2 vp2 = pointList[j];
                        Vector3 vp = new Vector3(vp2.x, vp2.y, 0f);
                        //C++ TO C# CONVERTER WARNING: The following line was determined to be a copy constructor call - this should be verified and a copy constructor should be created if it does not yet exist:
                        //ORIGINAL LINE: Vector3 normal = Vector3::UNIT_Z;
                        Vector3 normal = (Vector3.UNIT_Z);

                        Vector3 newPoint = extrusionPath.getPoint(extrusionPath.getSegCount()) + qEnd * (scaleEnd * vp);
                        buffer.vertex(newPoint, qEnd * normal, vp2);
                    }
                    for (int ii = 0; ii < indexBuffer.Count / 3; ii++) {
                        buffer.index(indexBuffer[ii * 3]);
                        buffer.index(indexBuffer[ii * 3 + 1]);
                        buffer.index(indexBuffer[ii * 3 + 2]);
                    }
                }
            }
        }
        //-----------------------------------------------------------------------
        //typedef std::vector<PathCoordinate> PathIntersection;
        public static void _extrudeIntersectionImpl(ref TriangleBuffer buffer, std_vector<MultiPath.PathCoordinate> intersection, MultiPath multiPath, Shape shape, Track shapeTextureTrack) {
            Vector3 intersectionLocation = multiPath.getPath((int)intersection[0].pathIndex).getPoint((int)intersection[0].pointIndex);
            Quaternion firstOrientation = Utils._computeQuaternion(multiPath.getPath((int)intersection[0].pathIndex).getDirectionBefore((int)intersection[0].pointIndex));
            Vector3 refX = firstOrientation * Vector3.UNIT_X;
            Vector3 refZ = firstOrientation * Vector3.UNIT_Z;

            std_vector<Vector2> v2s = new std_vector<Vector2>();
            std_vector<MultiPath.PathCoordinate> coords = new std_vector<MultiPath.PathCoordinate>();
            std_vector<float> direction = new std_vector<float>();

            for (int i = 0; i < intersection.size(); ++i) {
                Path path = multiPath.getPath((int)intersection[i].pathIndex);
                int pointIndex = (int)intersection[i].pointIndex;
                if (pointIndex > 0 || path.isClosed()) {
                    Vector3 vb = path.getDirectionBefore(pointIndex);
                    Vector2 vb2 = new Vector2(vb.DotProduct(refX), vb.DotProduct(refZ));
                    v2s.push_back(vb2);
                    coords.push_back(intersection[i]);
                    direction.push_back(1);
                }
                if (pointIndex < path.getSegCount() || path.isClosed()) {
                    Vector3 va = -path.getDirectionAfter(pointIndex);
                    Vector2 va2 = new Vector2(va.DotProduct(refX), va.DotProduct(refZ));
                    v2s.push_back(va2);
                    coords.push_back(intersection[i]);
                    direction.push_back(-1);
                }
            }

            std_map<Radian, int> angles = new std_map<Radian, int>();
            for (int i = 1; i < v2s.Count; ++i) {
                //angles[Utils.angleTo(v2s[0], v2s[i])] = i;
                angles.insert(Utils.angleTo(v2s[0], v2s[i]), i);
            }
            std_vector<int> orderedIndices = new std_vector<int>();
            orderedIndices.push_back(0);
            //for (std_map<Radian, int>.Enumerator it = angles.begin(); it != angles.end(); ++it)
            foreach (var it in angles)
                orderedIndices.push_back(it.Value);
            for (int i = 0; i < orderedIndices.size(); ++i) {
                int idx = orderedIndices[i];
                int idxBefore = orderedIndices[Utils.modulo(i - 1, orderedIndices.Count)];
                int idxAfter = orderedIndices[Utils.modulo(i + 1, orderedIndices.Count)];
                Radian angleBefore = (Utils.angleBetween(v2s[idx], v2s[idxBefore]) - (Radian)Math.PI) / 2;
                Radian angleAfter = ((Radian)Math.PI - Utils.angleBetween(v2s[idx], v2s[idxAfter])) / 2;

                int pointIndex = (int)((int)coords[idx].pointIndex - direction[idx]);
                Path path = multiPath.getPath((int)coords[idx].pathIndex);

                Quaternion qStd = Utils._computeQuaternion(path.getAvgDirection(pointIndex) * direction[idx]);
                float lineicPos = 0f;
                float uTexCoord = path.getLengthAtPoint(pointIndex) / path.getTotalLength();

                // Shape making the joint with "standard extrusion"
                _extrudeShape(ref buffer, shape, path.getPoint(pointIndex), qStd, qStd, 1.0f, 1.0f, 1.0f, shape.getTotalLength(), uTexCoord, true, shapeTextureTrack);

                // Modified shape at the intersection
                Quaternion q = new Quaternion();
                if (direction[idx] > 0f)
                    q = Utils._computeQuaternion(path.getDirectionBefore((int)coords[idx].pointIndex));
                else
                    q = Utils._computeQuaternion(-path.getDirectionAfter((int)coords[idx].pointIndex));
                Quaternion qLeft = q * new Quaternion(angleBefore, Vector3.UNIT_Y);
                Quaternion qRight = q * new Quaternion(angleAfter, Vector3.UNIT_Y);
                float scaleLeft = 1.0f / Math.Abs(Math.Cos(angleBefore));
                float scaleRight = 1.0f / Math.Abs(Math.Cos(angleAfter));

                uTexCoord = path.getLengthAtPoint((int)coords[idx].pointIndex) / path.getTotalLength();
                _extrudeShape(ref buffer, shape, path.getPoint((int)coords[idx].pointIndex), qLeft, qRight, 1.0f, scaleLeft, scaleRight, shape.getTotalLength(), uTexCoord, false, shapeTextureTrack);
            }
        }
    }



}