310 lines
No EOL
17 KiB
HTML
310 lines
No EOL
17 KiB
HTML
|
|
|
|
<!DOCTYPE html>
|
|
<html class="writer-html5" lang="en" >
|
|
<head>
|
|
<meta charset="utf-8">
|
|
|
|
<meta name="viewport" content="width=device-width, initial-scale=1.0">
|
|
|
|
<title>Linefollower Examples — CompLib 0.0.2 documentation</title>
|
|
|
|
|
|
|
|
<link rel="stylesheet" href="../_static/css/theme.css" type="text/css" />
|
|
<link rel="stylesheet" href="../_static/pygments.css" type="text/css" />
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
<!--[if lt IE 9]>
|
|
<script src="../_static/js/html5shiv.min.js"></script>
|
|
<![endif]-->
|
|
|
|
|
|
<script type="text/javascript" id="documentation_options" data-url_root="../" src="../_static/documentation_options.js"></script>
|
|
<script src="../_static/jquery.js"></script>
|
|
<script src="../_static/underscore.js"></script>
|
|
<script src="../_static/doctools.js"></script>
|
|
|
|
<script type="text/javascript" src="../_static/js/theme.js"></script>
|
|
|
|
|
|
<link rel="index" title="Index" href="../genindex.html" />
|
|
<link rel="search" title="Search" href="../search.html" />
|
|
<link rel="next" title="Logging" href="Logging.html" />
|
|
<link rel="prev" title="Infrared Wrapper" href="IRWrapper.html" />
|
|
</head>
|
|
|
|
<body class="wy-body-for-nav">
|
|
|
|
|
|
<div class="wy-grid-for-nav">
|
|
|
|
<nav data-toggle="wy-nav-shift" class="wy-nav-side">
|
|
<div class="wy-side-scroll">
|
|
<div class="wy-side-nav-search" >
|
|
|
|
|
|
|
|
<a href="../index.html" class="icon icon-home" alt="Documentation Home"> CompLib
|
|
|
|
|
|
|
|
</a>
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
<div role="search">
|
|
<form id="rtd-search-form" class="wy-form" action="../search.html" method="get">
|
|
<input type="text" name="q" placeholder="Search docs" />
|
|
<input type="hidden" name="check_keywords" value="yes" />
|
|
<input type="hidden" name="area" value="default" />
|
|
</form>
|
|
</div>
|
|
|
|
|
|
</div>
|
|
|
|
|
|
<div class="wy-menu wy-menu-vertical" data-spy="affix" role="navigation" aria-label="main navigation">
|
|
|
|
|
|
|
|
|
|
|
|
|
|
<ul class="current">
|
|
<li class="toctree-l1"><a class="reference internal" href="../index.html">Robo4you Competition Library</a></li>
|
|
<li class="toctree-l1"><a class="reference internal" href="../other/usage.html">Usage</a></li>
|
|
<li class="toctree-l1"><a class="reference internal" href="Api.html">Api</a></li>
|
|
<li class="toctree-l1"><a class="reference internal" href="Aruco.html">Aruco</a></li>
|
|
<li class="toctree-l1"><a class="reference internal" href="Battery.html">Battery</a></li>
|
|
<li class="toctree-l1"><a class="reference internal" href="Buzzer.html">Buzzer</a></li>
|
|
<li class="toctree-l1"><a class="reference internal" href="IRSensor.html">Infrared Sensor</a></li>
|
|
<li class="toctree-l1"><a class="reference internal" href="IRWrapper.html">Infrared Wrapper</a></li>
|
|
<li class="toctree-l1 current"><a class="current reference internal" href="#">Linefollower Examples</a><ul>
|
|
<li class="toctree-l2"><a class="reference internal" href="#simple-linefollower">Simple Linefollower</a></li>
|
|
</ul>
|
|
</li>
|
|
<li class="toctree-l1"><a class="reference internal" href="Logging.html">Logging</a></li>
|
|
<li class="toctree-l1"><a class="reference internal" href="Motor.html">Motor</a></li>
|
|
<li class="toctree-l1"><a class="reference internal" href="Servo.html">Servo</a></li>
|
|
<li class="toctree-l1"><a class="reference internal" href="Vision.html">Vision</a></li>
|
|
</ul>
|
|
|
|
|
|
|
|
</div>
|
|
|
|
</div>
|
|
</nav>
|
|
|
|
<section data-toggle="wy-nav-shift" class="wy-nav-content-wrap">
|
|
|
|
|
|
<nav class="wy-nav-top" aria-label="top navigation">
|
|
|
|
<i data-toggle="wy-nav-top" class="fa fa-bars"></i>
|
|
<a href="../index.html">CompLib</a>
|
|
|
|
</nav>
|
|
|
|
|
|
<div class="wy-nav-content">
|
|
|
|
<div class="rst-content">
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
<div role="navigation" aria-label="breadcrumbs navigation">
|
|
|
|
<ul class="wy-breadcrumbs">
|
|
|
|
<li><a href="../index.html" class="icon icon-home"></a> »</li>
|
|
|
|
<li>Linefollower Examples</li>
|
|
|
|
|
|
<li class="wy-breadcrumbs-aside">
|
|
|
|
|
|
<a href="../_sources/lib/Linefollower.rst.txt" rel="nofollow"> View page source</a>
|
|
|
|
|
|
</li>
|
|
|
|
</ul>
|
|
|
|
|
|
<hr/>
|
|
</div>
|
|
<div role="main" class="document" itemscope="itemscope" itemtype="http://schema.org/Article">
|
|
<div itemprop="articleBody">
|
|
|
|
<div class="section" id="linefollower-examples">
|
|
<span id="lib-linefollower"></span><h1>Linefollower Examples<a class="headerlink" href="#linefollower-examples" title="Permalink to this headline">¶</a></h1>
|
|
<div class="section" id="simple-linefollower">
|
|
<h2>Simple Linefollower<a class="headerlink" href="#simple-linefollower" title="Permalink to this headline">¶</a></h2>
|
|
<div class="highlight-python notranslate"><div class="highlight"><pre><span></span><span class="kn">import</span> <span class="nn">time</span>
|
|
|
|
<span class="kn">from</span> <span class="nn">compLib.IRWrapper</span> <span class="kn">import</span> <span class="n">IRWrapper</span>
|
|
<span class="kn">from</span> <span class="nn">compLib.Motor</span> <span class="kn">import</span> <span class="n">Motor</span>
|
|
|
|
<span class="n">STRAIGHT_SPEED</span> <span class="o">=</span> <span class="mf">40.0</span>
|
|
<span class="n">TURN_SPEED</span> <span class="o">=</span> <span class="mf">40.0</span>
|
|
|
|
<span class="n">COLOR_BREAK</span> <span class="o">=</span> <span class="mi">500</span>
|
|
|
|
|
|
<span class="k">def</span> <span class="nf">drive</span><span class="p">(</span><span class="n">left</span><span class="p">,</span> <span class="n">right</span><span class="p">,</span> <span class="n">active_break</span><span class="o">=</span><span class="kc">False</span><span class="p">,</span> <span class="n">back_mult</span><span class="o">=</span><span class="mf">0.0</span><span class="p">):</span>
|
|
<span class="n">left</span> <span class="o">=</span> <span class="nb">max</span><span class="p">(</span><span class="nb">min</span><span class="p">(</span><span class="n">left</span><span class="p">,</span> <span class="mi">100</span><span class="p">),</span> <span class="o">-</span><span class="mi">100</span><span class="p">)</span>
|
|
<span class="n">right</span> <span class="o">=</span> <span class="nb">max</span><span class="p">(</span><span class="nb">min</span><span class="p">(</span><span class="n">right</span><span class="p">,</span> <span class="mi">100</span><span class="p">),</span> <span class="o">-</span><span class="mi">100</span><span class="p">)</span>
|
|
|
|
<span class="nb">print</span><span class="p">(</span><span class="s2">"left </span><span class="si">{}</span><span class="s2"> right </span><span class="si">{}</span><span class="s2">"</span><span class="o">.</span><span class="n">format</span><span class="p">(</span><span class="n">left</span><span class="p">,</span> <span class="n">right</span><span class="p">))</span>
|
|
|
|
<span class="n">Motor</span><span class="o">.</span><span class="n">power</span><span class="p">(</span><span class="mi">0</span><span class="p">,</span> <span class="n">left</span><span class="p">)</span>
|
|
<span class="n">Motor</span><span class="o">.</span><span class="n">power</span><span class="p">(</span><span class="mi">1</span><span class="p">,</span> <span class="n">left</span> <span class="o">*</span> <span class="n">back_mult</span><span class="p">)</span>
|
|
<span class="n">Motor</span><span class="o">.</span><span class="n">power</span><span class="p">(</span><span class="mi">2</span><span class="p">,</span> <span class="n">right</span> <span class="o">*</span> <span class="n">back_mult</span><span class="p">)</span>
|
|
<span class="n">Motor</span><span class="o">.</span><span class="n">power</span><span class="p">(</span><span class="mi">3</span><span class="p">,</span> <span class="n">right</span><span class="p">)</span>
|
|
|
|
<span class="k">if</span> <span class="n">active_break</span><span class="p">:</span>
|
|
<span class="n">time</span><span class="o">.</span><span class="n">sleep</span><span class="p">(</span><span class="mf">0.001</span><span class="p">)</span>
|
|
|
|
<span class="n">Motor</span><span class="o">.</span><span class="n">power</span><span class="p">(</span><span class="mi">0</span><span class="p">,</span> <span class="mi">10</span><span class="p">)</span>
|
|
<span class="n">Motor</span><span class="o">.</span><span class="n">power</span><span class="p">(</span><span class="mi">1</span><span class="p">,</span> <span class="mi">10</span><span class="p">)</span>
|
|
<span class="n">Motor</span><span class="o">.</span><span class="n">power</span><span class="p">(</span><span class="mi">2</span><span class="p">,</span> <span class="mi">10</span><span class="p">)</span>
|
|
<span class="n">Motor</span><span class="o">.</span><span class="n">power</span><span class="p">(</span><span class="mi">3</span><span class="p">,</span> <span class="mi">10</span><span class="p">)</span>
|
|
|
|
<span class="n">time</span><span class="o">.</span><span class="n">sleep</span><span class="p">(</span><span class="mf">0.001</span><span class="p">)</span>
|
|
|
|
|
|
<span class="k">def</span> <span class="nf">follow_till_line</span><span class="p">():</span>
|
|
<span class="k">while</span> <span class="kc">True</span><span class="p">:</span>
|
|
<span class="nb">print</span><span class="p">(</span><span class="s2">"left: </span><span class="si">{:.2f}</span><span class="s2"> middle: </span><span class="si">{:.2f}</span><span class="s2"> right: </span><span class="si">{:.2f}</span><span class="s2">"</span><span class="o">.</span><span class="n">format</span><span class="p">(</span><span class="n">IRWrapper</span><span class="o">.</span><span class="n">bottom_left_calibrated</span><span class="p">(),</span>
|
|
<span class="n">IRWrapper</span><span class="o">.</span><span class="n">bottom_middle_calibrated</span><span class="p">(),</span>
|
|
<span class="n">IRWrapper</span><span class="o">.</span><span class="n">bottom_right_calibrated</span><span class="p">()))</span>
|
|
|
|
<span class="n">left</span> <span class="o">=</span> <span class="n">IRWrapper</span><span class="o">.</span><span class="n">bottom_left_calibrated</span><span class="p">()</span>
|
|
<span class="n">right</span> <span class="o">=</span> <span class="n">IRWrapper</span><span class="o">.</span><span class="n">bottom_right_calibrated</span><span class="p">()</span>
|
|
|
|
<span class="k">if</span> <span class="n">left</span> <span class="o">></span> <span class="n">COLOR_BREAK</span><span class="p">:</span>
|
|
<span class="n">drive</span><span class="p">(</span><span class="o">-</span><span class="n">TURN_SPEED</span><span class="p">,</span> <span class="n">TURN_SPEED</span><span class="p">,</span> <span class="n">back_mult</span><span class="o">=</span><span class="mf">1.25</span><span class="p">)</span>
|
|
<span class="k">while</span> <span class="n">IRWrapper</span><span class="o">.</span><span class="n">bottom_middle_calibrated</span><span class="p">()</span> <span class="o"><</span> <span class="n">COLOR_BREAK</span> <span class="ow">and</span> \
|
|
<span class="n">IRWrapper</span><span class="o">.</span><span class="n">bottom_right_calibrated</span><span class="p">()</span> <span class="o"><</span> <span class="n">COLOR_BREAK</span><span class="p">:</span>
|
|
<span class="k">pass</span>
|
|
<span class="n">drive</span><span class="p">(</span><span class="mi">0</span><span class="p">,</span> <span class="mi">0</span><span class="p">)</span>
|
|
<span class="k">elif</span> <span class="n">right</span> <span class="o">></span> <span class="n">COLOR_BREAK</span><span class="p">:</span>
|
|
<span class="n">drive</span><span class="p">(</span><span class="n">TURN_SPEED</span><span class="p">,</span> <span class="o">-</span><span class="n">TURN_SPEED</span><span class="p">,</span> <span class="n">back_mult</span><span class="o">=</span><span class="mf">1.25</span><span class="p">)</span>
|
|
<span class="k">while</span> <span class="n">IRWrapper</span><span class="o">.</span><span class="n">bottom_middle_calibrated</span><span class="p">()</span> <span class="o"><</span> <span class="n">COLOR_BREAK</span> <span class="ow">and</span> \
|
|
<span class="n">IRWrapper</span><span class="o">.</span><span class="n">bottom_left_calibrated</span><span class="p">()</span> <span class="o"><</span> <span class="n">COLOR_BREAK</span><span class="p">:</span>
|
|
<span class="k">pass</span>
|
|
<span class="n">drive</span><span class="p">(</span><span class="mi">0</span><span class="p">,</span> <span class="mi">0</span><span class="p">)</span>
|
|
<span class="k">else</span><span class="p">:</span>
|
|
<span class="n">drive</span><span class="p">(</span><span class="n">STRAIGHT_SPEED</span><span class="p">,</span> <span class="n">STRAIGHT_SPEED</span><span class="p">,</span> <span class="kc">True</span><span class="p">)</span>
|
|
|
|
<span class="k">if</span> <span class="n">IRWrapper</span><span class="o">.</span><span class="n">bottom_left_calibrated</span><span class="p">()</span> <span class="o">></span> <span class="mi">750</span> <span class="ow">and</span> <span class="n">IRWrapper</span><span class="o">.</span><span class="n">bottom_right_calibrated</span><span class="p">()</span> <span class="o">></span> <span class="mi">750</span><span class="p">:</span>
|
|
<span class="k">break</span>
|
|
|
|
<span class="nb">print</span><span class="p">(</span><span class="s2">"left: </span><span class="si">{}</span><span class="s2"> middle: </span><span class="si">{}</span><span class="s2"> right: </span><span class="si">{}</span><span class="s2">"</span><span class="o">.</span><span class="n">format</span><span class="p">(</span><span class="n">IRWrapper</span><span class="o">.</span><span class="n">bottom_left_calibrated</span><span class="p">(),</span>
|
|
<span class="n">IRWrapper</span><span class="o">.</span><span class="n">bottom_middle_calibrated</span><span class="p">(),</span>
|
|
<span class="n">IRWrapper</span><span class="o">.</span><span class="n">bottom_right_calibrated</span><span class="p">()))</span>
|
|
|
|
<span class="n">drive</span><span class="p">(</span><span class="mi">0</span><span class="p">,</span> <span class="mi">0</span><span class="p">)</span>
|
|
|
|
<span class="n">time</span><span class="o">.</span><span class="n">sleep</span><span class="p">(</span><span class="mf">0.2</span><span class="p">)</span>
|
|
|
|
|
|
<span class="k">if</span> <span class="vm">__name__</span> <span class="o">==</span> <span class="s2">"__main__"</span><span class="p">:</span>
|
|
<span class="c1"># Put bot with middle sensor onto black line</span>
|
|
<span class="n">IRWrapper</span><span class="o">.</span><span class="n">calibrate</span><span class="p">()</span>
|
|
|
|
<span class="c1"># Initialize Motors, so the bot doesn't speed off instantly</span>
|
|
<span class="n">drive</span><span class="p">(</span><span class="mi">1</span><span class="p">,</span> <span class="mi">1</span><span class="p">)</span>
|
|
<span class="n">time</span><span class="o">.</span><span class="n">sleep</span><span class="p">(</span><span class="mi">1</span><span class="p">)</span>
|
|
|
|
<span class="c1"># Follow line, till the left and right sensor are on black</span>
|
|
<span class="n">follow_till_line</span><span class="p">()</span>
|
|
</pre></div>
|
|
</div>
|
|
</div>
|
|
</div>
|
|
|
|
|
|
</div>
|
|
|
|
</div>
|
|
<footer>
|
|
|
|
<div class="rst-footer-buttons" role="navigation" aria-label="footer navigation">
|
|
|
|
<a href="Logging.html" class="btn btn-neutral float-right" title="Logging" accesskey="n" rel="next">Next <span class="fa fa-arrow-circle-right"></span></a>
|
|
|
|
|
|
<a href="IRWrapper.html" class="btn btn-neutral float-left" title="Infrared Wrapper" accesskey="p" rel="prev"><span class="fa fa-arrow-circle-left"></span> Previous</a>
|
|
|
|
</div>
|
|
|
|
|
|
<hr/>
|
|
|
|
<div role="contentinfo">
|
|
<p>
|
|
|
|
© Copyright 2021, robo4you
|
|
|
|
</p>
|
|
</div>
|
|
|
|
|
|
|
|
Built with <a href="http://sphinx-doc.org/">Sphinx</a> using a
|
|
|
|
<a href="https://github.com/rtfd/sphinx_rtd_theme">theme</a>
|
|
|
|
provided by <a href="https://readthedocs.org">Read the Docs</a>.
|
|
|
|
</footer>
|
|
|
|
</div>
|
|
</div>
|
|
|
|
</section>
|
|
|
|
</div>
|
|
|
|
|
|
<script type="text/javascript">
|
|
jQuery(function () {
|
|
SphinxRtdTheme.Navigation.enable(true);
|
|
});
|
|
</script>
|
|
|
|
|
|
|
|
|
|
|
|
|
|
</body>
|
|
</html> |