<mxfile host="app.diagrams.net" agent="Mozilla/5.0 (X11; Linux x86_64; rv:146.0) Gecko/20100101 Firefox/146.0" version="29.6.0">
  <diagram name="Page-1" id="cI0x3Ov2nbLPwVbvmFNF">
    <mxGraphModel dx="2373" dy="1020" grid="1" gridSize="10" guides="1" tooltips="1" connect="1" arrows="1" fold="1" page="1" pageScale="1" pageWidth="850" pageHeight="1100" math="0" shadow="0">
      <root>
        <mxCell id="0" />
        <mxCell id="1" parent="0" />
        <mxCell id="u2eUU-9aFe3rVza2QzJR-1" parent="1" style="ellipse;whiteSpace=wrap;html=1;" value="IDLE" vertex="1">
          <mxGeometry height="80" width="80" x="100" y="400" as="geometry" />
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-2" parent="1" style="ellipse;whiteSpace=wrap;html=1;" value="&lt;div&gt;Position Control&lt;/div&gt;&lt;div&gt;INIT&lt;/div&gt;" vertex="1">
          <mxGeometry height="80" width="80" x="280" y="280" as="geometry" />
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-3" parent="1" style="ellipse;whiteSpace=wrap;html=1;" value="&lt;div&gt;Position&lt;/div&gt;&lt;div&gt;Control&lt;/div&gt;" vertex="1">
          <mxGeometry height="80" width="80" x="600" y="280" as="geometry" />
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-20" edge="1" parent="1" style="edgeStyle=orthogonalEdgeStyle;rounded=0;orthogonalLoop=1;jettySize=auto;html=1;entryX=0.962;entryY=0.293;entryDx=0;entryDy=0;entryPerimeter=0;" target="u2eUU-9aFe3rVza2QzJR-5">
          <mxGeometry relative="1" as="geometry">
            <mxPoint x="600" y="544" as="sourcePoint" />
            <mxPoint x="360" y="544" as="targetPoint" />
          </mxGeometry>
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-21" connectable="0" parent="u2eUU-9aFe3rVza2QzJR-20" style="edgeLabel;html=1;align=center;verticalAlign=middle;resizable=0;points=[];" value="&lt;div&gt;/&amp;nbsp;Orientation setpoint&lt;/div&gt;" vertex="1">
          <mxGeometry relative="1" x="0.4225" y="-2" as="geometry">
            <mxPoint x="61" y="-8" as="offset" />
          </mxGeometry>
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-4" parent="1" style="ellipse;whiteSpace=wrap;html=1;" value="&lt;div&gt;Orientation Control&lt;/div&gt;&lt;div&gt;INIT&lt;/div&gt;" vertex="1">
          <mxGeometry height="80" width="80" x="600" y="520" as="geometry" />
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-23" edge="1" parent="1" source="u2eUU-9aFe3rVza2QzJR-5" style="edgeStyle=orthogonalEdgeStyle;rounded=0;orthogonalLoop=1;jettySize=auto;html=1;entryX=0.5;entryY=1;entryDx=0;entryDy=0;" target="u2eUU-9aFe3rVza2QzJR-2">
          <mxGeometry relative="1" as="geometry" />
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-24" connectable="0" parent="u2eUU-9aFe3rVza2QzJR-23" style="edgeLabel;html=1;align=center;verticalAlign=middle;resizable=0;points=[];" value="&lt;div&gt;New destination AND&lt;/div&gt;&lt;div&gt;&amp;nbsp;outside position threshold&lt;/div&gt;" vertex="1">
          <mxGeometry relative="1" x="-0.2062" y="-2" as="geometry">
            <mxPoint as="offset" />
          </mxGeometry>
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-5" parent="1" style="ellipse;whiteSpace=wrap;html=1;" value="&lt;div&gt;Orientation&lt;/div&gt;&lt;div&gt;Contorl&lt;/div&gt;" vertex="1">
          <mxGeometry height="80" width="80" x="280" y="520" as="geometry" />
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-6" edge="1" parent="1" source="u2eUU-9aFe3rVza2QzJR-1" style="endArrow=classic;html=1;rounded=0;entryX=0;entryY=0.5;entryDx=0;entryDy=0;exitX=1;exitY=0;exitDx=0;exitDy=0;" target="u2eUU-9aFe3rVza2QzJR-2" value="">
          <mxGeometry height="50" relative="1" width="50" as="geometry">
            <mxPoint x="160" y="400" as="sourcePoint" />
            <mxPoint x="210" y="350" as="targetPoint" />
          </mxGeometry>
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-7" connectable="0" parent="u2eUU-9aFe3rVza2QzJR-6" style="edgeLabel;html=1;align=center;verticalAlign=middle;resizable=0;points=[];" value="&lt;div&gt;New destinationd AND&lt;/div&gt;&lt;div&gt;outside position threshold&lt;/div&gt;" vertex="1">
          <mxGeometry relative="1" x="-0.3932" y="1" as="geometry">
            <mxPoint x="8" y="-13" as="offset" />
          </mxGeometry>
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-14" edge="1" parent="1" source="u2eUU-9aFe3rVza2QzJR-2" style="endArrow=classic;html=1;rounded=0;entryX=0;entryY=0.5;entryDx=0;entryDy=0;exitX=1;exitY=0.5;exitDx=0;exitDy=0;" target="u2eUU-9aFe3rVza2QzJR-3" value="">
          <mxGeometry height="50" relative="1" width="50" as="geometry">
            <mxPoint x="420" y="300" as="sourcePoint" />
            <mxPoint x="470" y="250" as="targetPoint" />
          </mxGeometry>
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-15" connectable="0" parent="u2eUU-9aFe3rVza2QzJR-14" style="edgeLabel;html=1;align=center;verticalAlign=middle;resizable=0;points=[];" value="/ Trajectory planning" vertex="1">
          <mxGeometry relative="1" x="0.2476" y="1" as="geometry">
            <mxPoint x="-24" y="-9" as="offset" />
          </mxGeometry>
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-18" edge="1" parent="1" source="u2eUU-9aFe3rVza2QzJR-3" style="endArrow=classic;html=1;rounded=0;exitX=0.5;exitY=1;exitDx=0;exitDy=0;entryX=0.5;entryY=0;entryDx=0;entryDy=0;" target="u2eUU-9aFe3rVza2QzJR-4" value="">
          <mxGeometry height="50" relative="1" width="50" as="geometry">
            <mxPoint x="600" y="440" as="sourcePoint" />
            <mxPoint x="650" y="390" as="targetPoint" />
          </mxGeometry>
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-19" connectable="0" parent="u2eUU-9aFe3rVza2QzJR-18" style="edgeLabel;html=1;align=center;verticalAlign=middle;resizable=0;points=[];" value="&lt;div&gt;Arrived at destination&lt;/div&gt;" vertex="1">
          <mxGeometry relative="1" x="0.277" as="geometry">
            <mxPoint as="offset" />
          </mxGeometry>
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-32" edge="1" parent="1" source="u2eUU-9aFe3rVza2QzJR-3" style="curved=1;endArrow=classic;html=1;rounded=0;entryX=1;entryY=0;entryDx=0;entryDy=0;exitX=1;exitY=0.5;exitDx=0;exitDy=0;" target="u2eUU-9aFe3rVza2QzJR-3" value="">
          <mxGeometry height="50" relative="1" width="50" as="geometry">
            <Array as="points">
              <mxPoint x="730" y="340" />
              <mxPoint x="690" y="250" />
            </Array>
            <mxPoint x="690" y="300" as="sourcePoint" />
            <mxPoint x="680" y="250" as="targetPoint" />
          </mxGeometry>
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-33" connectable="0" parent="u2eUU-9aFe3rVza2QzJR-32" style="edgeLabel;html=1;align=center;verticalAlign=middle;resizable=0;points=[];" value="&lt;div&gt;New destination&amp;nbsp;&lt;/div&gt;&lt;div&gt;/ Trajectory planning&lt;/div&gt;" vertex="1">
          <mxGeometry relative="1" x="0.0958" y="-2" as="geometry">
            <mxPoint x="55" y="-2" as="offset" />
          </mxGeometry>
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-34" edge="1" parent="1" style="curved=1;endArrow=classic;html=1;rounded=0;entryX=0.271;entryY=0.942;entryDx=0;entryDy=0;entryPerimeter=0;" target="u2eUU-9aFe3rVza2QzJR-1" value="">
          <mxGeometry height="50" relative="1" width="50" as="geometry">
            <Array as="points">
              <mxPoint x="50" y="450.0000000000002" />
              <mxPoint x="90" y="460.0000000000002" />
              <mxPoint x="40" y="510.0000000000002" />
              <mxPoint x="80" y="520.0000000000002" />
            </Array>
            <mxPoint x="10" y="490.0000000000002" as="sourcePoint" />
            <mxPoint x="120" y="480.0000000000001" as="targetPoint" />
          </mxGeometry>
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-36" edge="1" parent="1" source="u2eUU-9aFe3rVza2QzJR-5" style="endArrow=classic;html=1;rounded=0;exitX=0;exitY=0.5;exitDx=0;exitDy=0;entryX=1;entryY=1;entryDx=0;entryDy=0;" target="u2eUU-9aFe3rVza2QzJR-1" value="">
          <mxGeometry height="50" relative="1" width="50" as="geometry">
            <mxPoint x="291.7157287525383" y="549.7157287525383" as="sourcePoint" />
            <mxPoint x="180.00000000000023" y="458.0000000000002" as="targetPoint" />
          </mxGeometry>
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-38" connectable="0" parent="u2eUU-9aFe3rVza2QzJR-36" style="edgeLabel;html=1;align=center;verticalAlign=middle;resizable=0;points=[];" value="&lt;div&gt;Orientation ==&amp;nbsp;&lt;/div&gt;&lt;div&gt;Orientation setpoint&lt;/div&gt;" vertex="1">
          <mxGeometry relative="1" x="-0.0869" y="-2" as="geometry">
            <mxPoint as="offset" />
          </mxGeometry>
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-39" edge="1" parent="1" source="u2eUU-9aFe3rVza2QzJR-4" style="endArrow=classic;html=1;rounded=0;entryX=1;entryY=1;entryDx=0;entryDy=0;exitX=0;exitY=0;exitDx=0;exitDy=0;" target="u2eUU-9aFe3rVza2QzJR-2" value="">
          <mxGeometry height="50" relative="1" width="50" as="geometry">
            <mxPoint x="430" y="470" as="sourcePoint" />
            <mxPoint x="480" y="420" as="targetPoint" />
          </mxGeometry>
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-40" connectable="0" parent="u2eUU-9aFe3rVza2QzJR-39" style="edgeLabel;html=1;align=center;verticalAlign=middle;resizable=0;points=[];" value="&lt;div&gt;New destination AND&lt;/div&gt;&lt;div&gt;outside position threshold&lt;/div&gt;" vertex="1">
          <mxGeometry relative="1" x="-0.2499" as="geometry">
            <mxPoint as="offset" />
          </mxGeometry>
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-41" edge="1" parent="1" style="curved=1;endArrow=classic;html=1;rounded=0;entryX=1;entryY=0;entryDx=0;entryDy=0;exitX=1;exitY=0.5;exitDx=0;exitDy=0;" value="">
          <mxGeometry height="50" relative="1" width="50" as="geometry">
            <Array as="points">
              <mxPoint x="732" y="540" />
              <mxPoint x="692" y="630" />
            </Array>
            <mxPoint x="682" y="560" as="sourcePoint" />
            <mxPoint x="670" y="588" as="targetPoint" />
          </mxGeometry>
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-42" connectable="0" parent="u2eUU-9aFe3rVza2QzJR-41" style="edgeLabel;html=1;align=center;verticalAlign=middle;resizable=0;points=[];" value="&lt;div&gt;New destination AND&lt;/div&gt;&lt;div&gt;inside position threshold&lt;/div&gt;" vertex="1">
          <mxGeometry relative="1" x="0.0958" y="-2" as="geometry">
            <mxPoint x="55" y="-2" as="offset" />
          </mxGeometry>
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-45" edge="1" parent="1" source="u2eUU-9aFe3rVza2QzJR-5" style="edgeStyle=orthogonalEdgeStyle;rounded=0;orthogonalLoop=1;jettySize=auto;html=1;entryX=-0.026;entryY=0.496;entryDx=0;entryDy=0;entryPerimeter=0;" target="u2eUU-9aFe3rVza2QzJR-4">
          <mxGeometry relative="1" as="geometry" />
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-46" connectable="0" parent="u2eUU-9aFe3rVza2QzJR-45" style="edgeLabel;html=1;align=center;verticalAlign=middle;resizable=0;points=[];" value="&lt;div&gt;New destination AND&lt;/div&gt;&lt;div&gt;outside position threshold AND&lt;/div&gt;&lt;div&gt;outside orientation threshold&lt;/div&gt;" vertex="1">
          <mxGeometry relative="1" x="0.0862" as="geometry">
            <mxPoint y="20" as="offset" />
          </mxGeometry>
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-49" edge="1" parent="1" source="u2eUU-9aFe3rVza2QzJR-1" style="curved=1;endArrow=classic;html=1;rounded=0;entryX=0.5;entryY=1;entryDx=0;entryDy=0;exitX=0.5;exitY=1;exitDx=0;exitDy=0;" target="u2eUU-9aFe3rVza2QzJR-4" value="">
          <mxGeometry height="50" relative="1" width="50" as="geometry">
            <Array as="points">
              <mxPoint x="160" y="650" />
              <mxPoint x="520" y="680" />
            </Array>
            <mxPoint x="-20" y="550" as="sourcePoint" />
            <mxPoint x="30" y="500" as="targetPoint" />
          </mxGeometry>
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-50" connectable="0" parent="u2eUU-9aFe3rVza2QzJR-49" style="edgeLabel;html=1;align=center;verticalAlign=middle;resizable=0;points=[];" value="&lt;div&gt;New destination AND&lt;/div&gt;&lt;div&gt;inside position threshold&lt;/div&gt;" vertex="1">
          <mxGeometry relative="1" x="0.2108" y="3" as="geometry">
            <mxPoint y="17" as="offset" />
          </mxGeometry>
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-52" edge="1" parent="1" style="curved=1;endArrow=classic;html=1;rounded=0;entryX=0;entryY=0;entryDx=0;entryDy=0;exitX=1;exitY=0.5;exitDx=0;exitDy=0;" target="u2eUU-9aFe3rVza2QzJR-1" value="">
          <mxGeometry height="50" relative="1" width="50" as="geometry">
            <Array as="points">
              <mxPoint x="50" y="450" />
              <mxPoint x="90" y="360" />
            </Array>
            <mxPoint x="100" y="430" as="sourcePoint" />
            <mxPoint x="112" y="402" as="targetPoint" />
          </mxGeometry>
        </mxCell>
        <mxCell id="u2eUU-9aFe3rVza2QzJR-53" connectable="0" parent="u2eUU-9aFe3rVza2QzJR-52" style="edgeLabel;html=1;align=center;verticalAlign=middle;resizable=0;points=[];" value="&lt;div&gt;New destination AND&lt;/div&gt;&lt;div&gt;inside position threshold AND&lt;/div&gt;&lt;div&gt;inside orientation threshold&lt;/div&gt;" vertex="1">
          <mxGeometry relative="1" x="0.0958" y="-2" as="geometry">
            <mxPoint x="-86" y="-5" as="offset" />
          </mxGeometry>
        </mxCell>
      </root>
    </mxGraphModel>
  </diagram>
</mxfile>
