diff --git a/doc/images/highway_exit.png b/doc/images/highway_exit.png
new file mode 100644
index 000000000..cf505917d
Binary files /dev/null and b/doc/images/highway_exit.png differ
diff --git a/doc/images/highway_exit.svg b/doc/images/highway_exit.svg
new file mode 100644
index 000000000..b5b373b4c
--- /dev/null
+++ b/doc/images/highway_exit.svg
@@ -0,0 +1,285 @@
+<?xml version="1.0" encoding="UTF-8" standalone="no"?>
+<!-- Created with Inkscape (http://www.inkscape.org/) -->
+
+<svg
+   xmlns:dc="http://purl.org/dc/elements/1.1/"
+   xmlns:cc="http://creativecommons.org/ns#"
+   xmlns:rdf="http://www.w3.org/1999/02/22-rdf-syntax-ns#"
+   xmlns:svg="http://www.w3.org/2000/svg"
+   xmlns="http://www.w3.org/2000/svg"
+   xmlns:sodipodi="http://sodipodi.sourceforge.net/DTD/sodipodi-0.dtd"
+   xmlns:inkscape="http://www.inkscape.org/namespaces/inkscape"
+   width="653.56873"
+   height="225.26402"
+   id="svg2"
+   version="1.1"
+   inkscape:version="0.48.5 r10040"
+   sodipodi:docname="highway_exit.svg">
+  <defs
+     id="defs4" />
+  <sodipodi:namedview
+     id="base"
+     pagecolor="#ffffff"
+     bordercolor="#666666"
+     borderopacity="1.0"
+     inkscape:pageopacity="0.0"
+     inkscape:pageshadow="2"
+     inkscape:zoom="1.4"
+     inkscape:cx="179.0304"
+     inkscape:cy="6.9237246"
+     inkscape:document-units="px"
+     inkscape:current-layer="layer1"
+     showgrid="false"
+     inkscape:window-width="1920"
+     inkscape:window-height="1058"
+     inkscape:window-x="3516"
+     inkscape:window-y="-4"
+     inkscape:window-maximized="1"
+     fit-margin-top="0"
+     fit-margin-left="0"
+     fit-margin-right="0"
+     fit-margin-bottom="0" />
+  <metadata
+     id="metadata7">
+    <rdf:RDF>
+      <cc:Work
+         rdf:about="">
+        <dc:format>image/svg+xml</dc:format>
+        <dc:type
+           rdf:resource="http://purl.org/dc/dcmitype/StillImage" />
+        <dc:title></dc:title>
+      </cc:Work>
+    </rdf:RDF>
+  </metadata>
+  <g
+     inkscape:label="Layer 1"
+     inkscape:groupmode="layer"
+     id="layer1"
+     transform="translate(-38.385799,-22.087807)">
+    <rect
+       style="fill:#b6b6b6;fill-opacity:1;stroke:none"
+       id="rect2991"
+       width="653.56873"
+       height="222.66431"
+       x="40.385799"
+       y="22.087807"
+       inkscape:export-filename="C:\GIT\ascgit058.UFM_Integration_ADTF\src\xfacelight_library\doc\images\highway_exit.png"
+       inkscape:export-xdpi="90"
+       inkscape:export-ydpi="90" />
+    <path
+       style="fill:none;stroke:#ffffff;stroke-width:3.0187068;stroke-linecap:butt;stroke-linejoin:miter;stroke-miterlimit:4;stroke-opacity:1;stroke-dasharray:none"
+       d="m 40.395158,115.95077 652.539852,0"
+       id="path3761"
+       inkscape:connector-curvature="0"
+       inkscape:export-filename="C:\GIT\ascgit058.UFM_Integration_ADTF\src\xfacelight_library\doc\images\highway_exit.png"
+       inkscape:export-xdpi="90"
+       inkscape:export-ydpi="90" />
+    <path
+       inkscape:connector-curvature="0"
+       id="path3763"
+       d="m 40.395158,109.95077 652.539852,0"
+       style="fill:none;stroke:#ffffff;stroke-width:3.0187068;stroke-linecap:butt;stroke-linejoin:miter;stroke-miterlimit:4;stroke-opacity:1;stroke-dasharray:none"
+       inkscape:export-filename="C:\GIT\ascgit058.UFM_Integration_ADTF\src\xfacelight_library\doc\images\highway_exit.png"
+       inkscape:export-xdpi="90"
+       inkscape:export-ydpi="90" />
+    <path
+       style="fill:none;stroke:#ffffff;stroke-width:3.0187068;stroke-linecap:butt;stroke-linejoin:miter;stroke-miterlimit:4;stroke-opacity:1;stroke-dasharray:24.14965439, 24.14965439;stroke-dashoffset:0"
+       d="m 40.395158,67.950768 652.539852,0"
+       id="path3765"
+       inkscape:connector-curvature="0"
+       inkscape:export-filename="C:\GIT\ascgit058.UFM_Integration_ADTF\src\xfacelight_library\doc\images\highway_exit.png"
+       inkscape:export-xdpi="90"
+       inkscape:export-ydpi="90" />
+    <path
+       inkscape:connector-curvature="0"
+       id="path3767"
+       d="m 40.395158,25.950768 652.539852,0"
+       style="fill:none;stroke:#ffffff;stroke-width:3.0187068;stroke-linecap:butt;stroke-linejoin:miter;stroke-miterlimit:4;stroke-opacity:1;stroke-dasharray:none"
+       inkscape:export-filename="C:\GIT\ascgit058.UFM_Integration_ADTF\src\xfacelight_library\doc\images\highway_exit.png"
+       inkscape:export-xdpi="90"
+       inkscape:export-ydpi="90" />
+    <path
+       inkscape:connector-curvature="0"
+       id="path3769"
+       d="m 40.395158,195.95077 268.968422,0"
+       style="fill:none;stroke:#ffffff;stroke-width:3.0187068;stroke-linecap:butt;stroke-linejoin:miter;stroke-miterlimit:4;stroke-opacity:1;stroke-dasharray:none"
+       inkscape:export-filename="C:\GIT\ascgit058.UFM_Integration_ADTF\src\xfacelight_library\doc\images\highway_exit.png"
+       inkscape:export-xdpi="90"
+       inkscape:export-ydpi="90"
+       sodipodi:nodetypes="cc" />
+    <path
+       style="fill:none;stroke:#ffffff;stroke-width:3.0187068;stroke-linecap:butt;stroke-linejoin:miter;stroke-miterlimit:4;stroke-opacity:1;stroke-dasharray:24.14965439, 24.14965439;stroke-dashoffset:0"
+       d="m 40.395158,153.95077 652.539852,0"
+       id="path3771"
+       inkscape:connector-curvature="0"
+       inkscape:export-filename="C:\GIT\ascgit058.UFM_Integration_ADTF\src\xfacelight_library\doc\images\highway_exit.png"
+       inkscape:export-xdpi="90"
+       inkscape:export-ydpi="90" />
+    <path
+       style="fill:none;stroke:#ffffff;stroke-width:3.0187068;stroke-linecap:butt;stroke-linejoin:miter;stroke-miterlimit:4;stroke-opacity:1;stroke-dasharray:24.14965439, 24.14965439;stroke-dashoffset:0"
+       d="m 282.83177,195.95077 410.10324,0"
+       id="path3781"
+       inkscape:connector-curvature="0"
+       sodipodi:nodetypes="cc"
+       inkscape:export-filename="C:\GIT\ascgit058.UFM_Integration_ADTF\src\xfacelight_library\doc\images\highway_exit.png"
+       inkscape:export-xdpi="90"
+       inkscape:export-ydpi="90" />
+    <path
+       inkscape:connector-curvature="0"
+       id="path3783"
+       d="m 305.05512,195.50406 56.55918,44.44671 331.32071,0"
+       style="fill:none;stroke:#ffffff;stroke-width:3.0187068;stroke-linecap:butt;stroke-linejoin:miter;stroke-miterlimit:4;stroke-opacity:1;stroke-dasharray:none"
+       sodipodi:nodetypes="ccc"
+       inkscape:export-filename="C:\GIT\ascgit058.UFM_Integration_ADTF\src\xfacelight_library\doc\images\highway_exit.png"
+       inkscape:export-xdpi="90"
+       inkscape:export-ydpi="90" />
+    <path
+       style="fill:none;stroke:#fffd29;stroke-width:3.01900005;stroke-linecap:butt;stroke-linejoin:miter;stroke-miterlimit:4;stroke-opacity:1;stroke-dasharray:3.019, 12.076;stroke-dashoffset:0"
+       d="m 40.395158,45.950768 652.539852,0"
+       id="path3785"
+       inkscape:connector-curvature="0"
+       inkscape:export-filename="C:\GIT\ascgit058.UFM_Integration_ADTF\src\xfacelight_library\doc\images\highway_exit.png"
+       inkscape:export-xdpi="90"
+       inkscape:export-ydpi="90" />
+    <path
+       inkscape:connector-curvature="0"
+       id="path3787"
+       d="m 40.395158,89.950768 652.539852,0"
+       style="fill:none;stroke:#fffd29;stroke-width:3.01900005;stroke-linecap:butt;stroke-linejoin:miter;stroke-miterlimit:4;stroke-opacity:1;stroke-dasharray:3.019, 12.076;stroke-dashoffset:0"
+       inkscape:export-filename="C:\GIT\ascgit058.UFM_Integration_ADTF\src\xfacelight_library\doc\images\highway_exit.png"
+       inkscape:export-xdpi="90"
+       inkscape:export-ydpi="90" />
+    <path
+       style="fill:none;stroke:#fffd29;stroke-width:3.01900005;stroke-linecap:butt;stroke-linejoin:miter;stroke-miterlimit:4;stroke-opacity:1;stroke-dasharray:3.019, 12.076;stroke-dashoffset:0"
+       d="m 40.395158,133.95077 652.539852,0"
+       id="path3789"
+       inkscape:connector-curvature="0"
+       inkscape:export-filename="C:\GIT\ascgit058.UFM_Integration_ADTF\src\xfacelight_library\doc\images\highway_exit.png"
+       inkscape:export-xdpi="90"
+       inkscape:export-ydpi="90" />
+    <path
+       inkscape:connector-curvature="0"
+       id="path3791"
+       d="m 40.395158,175.95077 652.539852,0"
+       style="fill:none;stroke:#fffd29;stroke-width:3.01900005;stroke-linecap:butt;stroke-linejoin:miter;stroke-miterlimit:4;stroke-opacity:1;stroke-dasharray:3.019, 12.076;stroke-dashoffset:0"
+       inkscape:export-filename="C:\GIT\ascgit058.UFM_Integration_ADTF\src\xfacelight_library\doc\images\highway_exit.png"
+       inkscape:export-xdpi="90"
+       inkscape:export-ydpi="90" />
+    <path
+       style="fill:none;stroke:#fffd29;stroke-width:3.01900005;stroke-linecap:butt;stroke-linejoin:miter;stroke-miterlimit:4;stroke-opacity:1;stroke-dasharray:3.019, 12.076;stroke-dashoffset:0"
+       d="m 327.53102,174.76675 42.1645,43.18402 323.23949,0"
+       id="path3793"
+       inkscape:connector-curvature="0"
+       sodipodi:nodetypes="ccc"
+       inkscape:export-filename="C:\GIT\ascgit058.UFM_Integration_ADTF\src\xfacelight_library\doc\images\highway_exit.png"
+       inkscape:export-xdpi="90"
+       inkscape:export-ydpi="90" />
+    <text
+       xml:space="preserve"
+       style="font-size:40px;font-style:normal;font-weight:normal;line-height:125%;letter-spacing:0px;word-spacing:0px;fill:#000000;fill-opacity:1;stroke:none;font-family:Sans"
+       x="44.35268"
+       y="60.325768"
+       id="text3795"
+       sodipodi:linespacing="125%"
+       inkscape:export-filename="C:\GIT\ascgit058.UFM_Integration_ADTF\src\xfacelight_library\doc\images\highway_exit.png"
+       inkscape:export-xdpi="90"
+       inkscape:export-ydpi="90"><tspan
+         sodipodi:role="line"
+         id="tspan3797"
+         x="44.35268"
+         y="60.325768">1</tspan></text>
+    <text
+       sodipodi:linespacing="125%"
+       id="text3799"
+       y="104.32577"
+       x="43.32729"
+       style="font-size:40px;font-style:normal;font-weight:normal;line-height:125%;letter-spacing:0px;word-spacing:0px;fill:#000000;fill-opacity:1;stroke:none;font-family:Sans"
+       xml:space="preserve"
+       inkscape:export-filename="C:\GIT\ascgit058.UFM_Integration_ADTF\src\xfacelight_library\doc\images\highway_exit.png"
+       inkscape:export-xdpi="90"
+       inkscape:export-ydpi="90"><tspan
+         y="104.32577"
+         x="43.32729"
+         id="tspan3801"
+         sodipodi:role="line">2</tspan></text>
+    <text
+       xml:space="preserve"
+       style="font-size:40px;font-style:normal;font-weight:normal;line-height:125%;letter-spacing:0px;word-spacing:0px;fill:#0000ff;fill-opacity:1;stroke:none;font-family:Sans"
+       x="42.926899"
+       y="148.07187"
+       id="text3803"
+       sodipodi:linespacing="125%"
+       inkscape:export-filename="C:\GIT\ascgit058.UFM_Integration_ADTF\src\xfacelight_library\doc\images\highway_exit.png"
+       inkscape:export-xdpi="90"
+       inkscape:export-ydpi="90"><tspan
+         sodipodi:role="line"
+         id="tspan3805"
+         x="42.926899"
+         y="148.07187">3</tspan></text>
+    <text
+       sodipodi:linespacing="125%"
+       id="text3807"
+       y="190.26718"
+       x="43.57143"
+       style="font-size:40px;font-style:normal;font-weight:normal;line-height:125%;letter-spacing:0px;word-spacing:0px;fill:#000000;fill-opacity:1;stroke:none;font-family:Sans"
+       xml:space="preserve"
+       inkscape:export-filename="C:\GIT\ascgit058.UFM_Integration_ADTF\src\xfacelight_library\doc\images\highway_exit.png"
+       inkscape:export-xdpi="90"
+       inkscape:export-ydpi="90"><tspan
+         y="190.26718"
+         x="43.57143"
+         id="tspan3809"
+         sodipodi:role="line">4</tspan></text>
+    <text
+       xml:space="preserve"
+       style="font-size:40px;font-style:normal;font-weight:normal;line-height:125%;letter-spacing:0px;word-spacing:0px;fill:#000000;fill-opacity:1;stroke:none;font-family:Sans"
+       x="42.829243"
+       y="230.54201"
+       id="text3811"
+       sodipodi:linespacing="125%"
+       inkscape:export-filename="C:\GIT\ascgit058.UFM_Integration_ADTF\src\xfacelight_library\doc\images\highway_exit.png"
+       inkscape:export-xdpi="90"
+       inkscape:export-ydpi="90"><tspan
+         sodipodi:role="line"
+         id="tspan3813"
+         x="42.829243"
+         y="230.54201">5</tspan></text>
+    <text
+       sodipodi:linespacing="125%"
+       id="text3815"
+       y="230.93362"
+       x="329.85715"
+       style="font-size:40px;font-style:normal;font-weight:normal;line-height:125%;letter-spacing:0px;word-spacing:0px;fill:#000000;fill-opacity:1;stroke:none;font-family:Sans"
+       xml:space="preserve"
+       inkscape:export-filename="C:\GIT\ascgit058.UFM_Integration_ADTF\src\xfacelight_library\doc\images\highway_exit.png"
+       inkscape:export-xdpi="90"
+       inkscape:export-ydpi="90"><tspan
+         y="230.93362"
+         x="329.85715"
+         id="tspan3817"
+         sodipodi:role="line">6</tspan></text>
+    <path
+       sodipodi:nodetypes="cc"
+       inkscape:export-ydpi="90"
+       inkscape:export-xdpi="90"
+       inkscape:export-filename="C:\GIT\ascgit058.UFM_Integration_ADTF\src\xfacelight_library\doc\images\highway_exit.png"
+       style="fill:none;stroke:#ffffff;stroke-width:3.0187068;stroke-linecap:butt;stroke-linejoin:miter;stroke-miterlimit:4;stroke-opacity:1;stroke-dasharray:none"
+       d="m 40.395158,239.95077 323.254132,0"
+       id="path3821"
+       inkscape:connector-curvature="0" />
+    <text
+       inkscape:export-ydpi="90"
+       inkscape:export-xdpi="90"
+       inkscape:export-filename="C:\GIT\ascgit058.UFM_Integration_ADTF\src\xfacelight_library\doc\images\highway_exit.png"
+       xml:space="preserve"
+       style="font-size:40px;font-style:normal;font-weight:normal;line-height:125%;letter-spacing:0px;word-spacing:0px;fill:#000000;fill-opacity:1;stroke:none;font-family:Sans"
+       x="354.85715"
+       y="190.08163"
+       id="text3823"
+       sodipodi:linespacing="125%"><tspan
+         sodipodi:role="line"
+         id="tspan3825"
+         x="354.85715"
+         y="190.08163">7</tspan></text>
+  </g>
+</svg>
diff --git a/doc/images/line_approximation_error.png b/doc/images/line_approximation_error.png
new file mode 100644
index 000000000..d0d6b4f03
Binary files /dev/null and b/doc/images/line_approximation_error.png differ
diff --git a/doc/images/line_approximation_error.svg b/doc/images/line_approximation_error.svg
new file mode 100644
index 000000000..65b160e1a
--- /dev/null
+++ b/doc/images/line_approximation_error.svg
@@ -0,0 +1,143 @@
+<?xml version="1.0" encoding="UTF-8" standalone="no"?>
+<!-- Created with Inkscape (http://www.inkscape.org/) -->
+
+<svg
+   xmlns:dc="http://purl.org/dc/elements/1.1/"
+   xmlns:cc="http://creativecommons.org/ns#"
+   xmlns:rdf="http://www.w3.org/1999/02/22-rdf-syntax-ns#"
+   xmlns:svg="http://www.w3.org/2000/svg"
+   xmlns="http://www.w3.org/2000/svg"
+   xmlns:sodipodi="http://sodipodi.sourceforge.net/DTD/sodipodi-0.dtd"
+   xmlns:inkscape="http://www.inkscape.org/namespaces/inkscape"
+   width="392.71301"
+   height="137.41576"
+   id="svg3827"
+   version="1.1"
+   inkscape:version="0.48.5 r10040"
+   sodipodi:docname="New document 3">
+  <defs
+     id="defs3829" />
+  <sodipodi:namedview
+     id="base"
+     pagecolor="#ffffff"
+     bordercolor="#666666"
+     borderopacity="1.0"
+     inkscape:pageopacity="0.0"
+     inkscape:pageshadow="2"
+     inkscape:zoom="1.4"
+     inkscape:cx="170.42634"
+     inkscape:cy="-45.714285"
+     inkscape:document-units="px"
+     inkscape:current-layer="layer1"
+     showgrid="false"
+     fit-margin-top="0"
+     fit-margin-left="0"
+     fit-margin-right="0"
+     fit-margin-bottom="0"
+     inkscape:window-width="1920"
+     inkscape:window-height="1058"
+     inkscape:window-x="3516"
+     inkscape:window-y="-4"
+     inkscape:window-maximized="1" />
+  <metadata
+     id="metadata3832">
+    <rdf:RDF>
+      <cc:Work
+         rdf:about="">
+        <dc:format>image/svg+xml</dc:format>
+        <dc:type
+           rdf:resource="http://purl.org/dc/dcmitype/StillImage" />
+        <dc:title></dc:title>
+      </cc:Work>
+    </rdf:RDF>
+  </metadata>
+  <g
+     inkscape:label="Layer 1"
+     inkscape:groupmode="layer"
+     id="layer1"
+     transform="translate(-93.145088,-206.375)">
+    <path
+       style="fill:none;stroke:#000000;stroke-width:1px;stroke-linecap:butt;stroke-linejoin:miter;stroke-opacity:1"
+       d="m 97.142857,335.21933 c 0,0 237.142853,27.14285 342.857143,-128.57143"
+       id="path3837"
+       inkscape:connector-curvature="0" />
+    <text
+       xml:space="preserve"
+       style="font-size:40px;font-style:normal;font-weight:normal;line-height:125%;letter-spacing:0px;word-spacing:0px;fill:#000000;fill-opacity:1;stroke:none;font-family:Sans"
+       x="442.85712"
+       y="218.79076"
+       id="text3839"
+       sodipodi:linespacing="125%"><tspan
+         sodipodi:role="line"
+         id="tspan3841"
+         x="442.85712"
+         y="218.79076"
+         style="font-size:11px">ideal line</tspan></text>
+    <path
+       sodipodi:type="arc"
+       style="fill:#0000ff;fill-opacity:1;stroke:none"
+       id="path3843"
+       sodipodi:cx="159.64285"
+       sodipodi:cy="379.86218"
+       sodipodi:rx="7.500001"
+       sodipodi:ry="7.500001"
+       d="m 167.14285,379.86218 c 0,4.14214 -3.35786,7.5 -7.5,7.5 -4.14213,0 -7.5,-3.35786 -7.5,-7.5 0,-4.14213 3.35787,-7.5 7.5,-7.5 4.14214,0 7.5,3.35787 7.5,7.5 z"
+       transform="translate(-50,-43.571429)" />
+    <path
+       transform="translate(242.14286,-128.57143)"
+       d="m 167.14285,379.86218 c 0,4.14214 -3.35786,7.5 -7.5,7.5 -4.14213,0 -7.5,-3.35786 -7.5,-7.5 0,-4.14213 3.35787,-7.5 7.5,-7.5 4.14214,0 7.5,3.35787 7.5,7.5 z"
+       sodipodi:ry="7.500001"
+       sodipodi:rx="7.500001"
+       sodipodi:cy="379.86218"
+       sodipodi:cx="159.64285"
+       id="path4353"
+       style="fill:#0000ff;fill-opacity:1;stroke:none"
+       sodipodi:type="arc" />
+    <path
+       style="fill:#0000ff;stroke:#0000ff;stroke-width:1px;stroke-linecap:butt;stroke-linejoin:miter;stroke-opacity:1"
+       d="M 109.28571,335.93361 401.42857,251.6479"
+       id="path4355"
+       inkscape:connector-curvature="0" />
+    <path
+       style="fill:none;stroke:#008000;stroke-width:1px;stroke-linecap:butt;stroke-linejoin:miter;stroke-opacity:1"
+       d="m 255.71429,293.79075 7.49061,27.95536"
+       id="path4357"
+       inkscape:connector-curvature="0" />
+    <text
+       xml:space="preserve"
+       style="font-size:40px;font-style:normal;font-weight:normal;line-height:125%;letter-spacing:0px;word-spacing:0px;fill:#000000;fill-opacity:1;stroke:none;font-family:Sans"
+       x="92.419991"
+       y="320.52048"
+       id="text3839-1"
+       sodipodi:linespacing="125%"><tspan
+         sodipodi:role="line"
+         id="tspan3841-7"
+         x="92.419991"
+         y="320.52048"
+         style="font-size:11px">point a</tspan></text>
+    <text
+       sodipodi:linespacing="125%"
+       id="text4380"
+       y="243.37762"
+       x="357.41998"
+       style="font-size:40px;font-style:normal;font-weight:normal;line-height:125%;letter-spacing:0px;word-spacing:0px;fill:#000000;fill-opacity:1;stroke:none;font-family:Sans"
+       xml:space="preserve"><tspan
+         style="font-size:11px"
+         y="243.37762"
+         x="357.41998"
+         id="tspan4382"
+         sodipodi:role="line">point b</tspan></text>
+    <text
+       sodipodi:linespacing="125%"
+       id="text4384"
+       y="306.94904"
+       x="259.56287"
+       style="font-size:40px;font-style:normal;font-weight:normal;line-height:125%;letter-spacing:0px;word-spacing:0px;fill:#000000;fill-opacity:1;stroke:none;font-family:Sans"
+       xml:space="preserve"><tspan
+         style="font-size:11px"
+         y="306.94904"
+         x="259.56287"
+         id="tspan4386"
+         sodipodi:role="line">&lt; 0.05m</tspan></text>
+  </g>
+</svg>