275 lines
No EOL
22 KiB
HTML
275 lines
No EOL
22 KiB
HTML
<!DOCTYPE html>
|
|
<html class="writer-html5" lang="de" >
|
|
<head>
|
|
<meta charset="utf-8" /><meta name="generator" content="Docutils 0.17.1: http://docutils.sourceforge.net/" />
|
|
|
|
<meta name="viewport" content="width=device-width, initial-scale=1.0" />
|
|
<title>Beispiele — CompLib 0.2.3 Dokumentation</title>
|
|
<link rel="stylesheet" href="../_static/pygments.css" type="text/css" />
|
|
<link rel="stylesheet" href="../_static/css/theme.css" type="text/css" />
|
|
<!--[if lt IE 9]>
|
|
<script src="../_static/js/html5shiv.min.js"></script>
|
|
<![endif]-->
|
|
|
|
<script data-url_root="../" id="documentation_options" src="../_static/documentation_options.js"></script>
|
|
<script src="../_static/jquery.js"></script>
|
|
<script src="../_static/underscore.js"></script>
|
|
<script src="../_static/_sphinx_javascript_frameworks_compat.js"></script>
|
|
<script src="../_static/doctools.js"></script>
|
|
<script src="../_static/sphinx_highlight.js"></script>
|
|
<script src="../_static/translations.js"></script>
|
|
<script src="../_static/js/theme.js"></script>
|
|
<link rel="index" title="Stichwortverzeichnis" href="../genindex.html" />
|
|
<link rel="search" title="Suche" href="../search.html" />
|
|
<link rel="next" title="compLib" href="../lib/index.html" />
|
|
<link rel="prev" title="FAQ" href="../faq.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">
|
|
<img src="../_static/compair-logo-white.svg" class="logo" alt="Logo"/>
|
|
</a>
|
|
<div role="search">
|
|
<form id="rtd-search-form" class="wy-form" action="../search.html" method="get">
|
|
<input type="text" name="q" placeholder="Dokumentation durchsuchen" />
|
|
<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="Navigation menu">
|
|
<ul class="current">
|
|
<li class="toctree-l1"><a class="reference internal" href="../gettingStarted/index.html">Erste Schritte</a></li>
|
|
<li class="toctree-l1"><a class="reference internal" href="../software/installation.html">Installationsanweisungen</a></li>
|
|
<li class="toctree-l1"><a class="reference internal" href="../faq.html">FAQ</a></li>
|
|
<li class="toctree-l1 current"><a class="current reference internal" href="#">Beispiele</a><ul>
|
|
<li class="toctree-l2"><a class="reference internal" href="#vorwarts-und-ruckwarts-fahren">Vorwärts und rückwärts fahren</a></li>
|
|
<li class="toctree-l2"><a class="reference internal" href="#eine-linie-verfolgen">Eine Linie verfolgen</a></li>
|
|
<li class="toctree-l2"><a class="reference internal" href="#funktionalitat-des-roboters-uberprufen">Funktionalität des Roboters überprüfen</a></li>
|
|
</ul>
|
|
</li>
|
|
<li class="toctree-l1"><a class="reference internal" href="../lib/index.html">compLib</a></li>
|
|
<li class="toctree-l1"><a class="reference internal" href="hardware.html">Hardware</a></li>
|
|
</ul>
|
|
|
|
</div>
|
|
</div>
|
|
</nav>
|
|
|
|
<section data-toggle="wy-nav-shift" class="wy-nav-content-wrap"><nav class="wy-nav-top" aria-label="Mobile navigation menu" >
|
|
<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="Page navigation">
|
|
<ul class="wy-breadcrumbs">
|
|
<li><a href="../index.html" class="icon icon-home"></a></li>
|
|
<li class="breadcrumb-item active">Beispiele</li>
|
|
<li class="wy-breadcrumbs-aside">
|
|
<a href="../_sources/other/usage.rst.txt" rel="nofollow"> Quelltext anzeigen</a>
|
|
</li>
|
|
</ul>
|
|
<hr/>
|
|
</div>
|
|
<div role="main" class="document" itemscope="itemscope" itemtype="http://schema.org/Article">
|
|
<div itemprop="articleBody">
|
|
|
|
<section id="beispiele">
|
|
<span id="other-usage"></span><h1>Beispiele<a class="headerlink" href="#beispiele" title="Permalink to this heading"></a></h1>
|
|
<section id="vorwarts-und-ruckwarts-fahren">
|
|
<h2>Vorwärts und rückwärts fahren<a class="headerlink" href="#vorwarts-und-ruckwarts-fahren" title="Permalink to this heading"></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.Motor</span> <span class="kn">import</span> <span class="o">*</span>
|
|
|
|
<span class="k">def</span> <span class="nf">forward</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="o">-</span><span class="mi">30</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">30</span><span class="p">)</span>
|
|
|
|
|
|
<span class="k">def</span> <span class="nf">backward</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">30</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="o">-</span><span class="mi">30</span><span class="p">)</span>
|
|
|
|
<span class="k">def</span> <span class="nf">main</span><span class="p">():</span>
|
|
<span class="nb">print</span><span class="p">(</span><span class="s2">"hallo ich bin ein roboter beep buup"</span><span class="p">)</span>
|
|
|
|
<span class="n">forward</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="n">backward</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="k">if</span> <span class="vm">__name__</span> <span class="o">==</span> <span class="s1">'__main__'</span><span class="p">:</span>
|
|
<span class="n">main</span><span class="p">()</span>
|
|
</pre></div>
|
|
</div>
|
|
</section>
|
|
<section id="eine-linie-verfolgen">
|
|
<h2>Eine Linie verfolgen<a class="headerlink" href="#eine-linie-verfolgen" title="Permalink to this heading"></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.Motor</span> <span class="kn">import</span> <span class="n">Motor</span>
|
|
<span class="kn">from</span> <span class="nn">compLib.Encoder</span> <span class="kn">import</span> <span class="n">Encoder</span>
|
|
<span class="kn">from</span> <span class="nn">compLib.IRSensor</span> <span class="kn">import</span> <span class="n">IRSensor</span>
|
|
|
|
<span class="n">COLOR_BREAK</span> <span class="o">=</span> <span class="mi">850</span>
|
|
<span class="n">DRIVE_SPEED</span> <span class="o">=</span> <span class="mi">35</span>
|
|
|
|
<span class="n">IRSensor</span><span class="o">.</span><span class="n">enable</span><span class="p">()</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">right</span> <span class="o">*=</span> <span class="o">-</span><span class="mi">1</span>
|
|
<span class="n">Motor</span><span class="o">.</span><span class="n">multiple_power</span><span class="p">((</span><span class="mi">0</span><span class="p">,</span> <span class="n">right</span><span class="p">),</span> <span class="p">(</span><span class="mi">3</span><span class="p">,</span> <span class="n">left</span><span class="p">))</span>
|
|
<span class="nb">print</span><span class="p">(</span><span class="sa">f</span><span class="s2">"</span><span class="si">{</span><span class="n">left</span><span class="si">}</span><span class="s2"> </span><span class="si">{</span><span class="n">right</span><span class="si">}</span><span class="s2">"</span><span class="p">)</span>
|
|
|
|
<span class="k">def</span> <span class="nf">follow</span><span class="p">():</span>
|
|
<span class="k">while</span> <span class="kc">True</span><span class="p">:</span>
|
|
<span class="n">sensors</span> <span class="o">=</span> <span class="n">IRSensor</span><span class="o">.</span><span class="n">read_all</span><span class="p">()</span>
|
|
|
|
<span class="k">if</span> <span class="n">sensors</span><span class="p">[</span><span class="mi">0</span><span class="p">]</span> <span class="o">></span> <span class="n">COLOR_BREAK</span><span class="p">:</span>
|
|
<span class="c1"># turn left</span>
|
|
<span class="n">drive</span><span class="p">(</span><span class="o">-</span><span class="n">DRIVE_SPEED</span><span class="p">,</span> <span class="n">DRIVE_SPEED</span><span class="p">)</span>
|
|
<span class="k">elif</span> <span class="n">sensors</span><span class="p">[</span><span class="mi">4</span><span class="p">]</span> <span class="o">></span> <span class="n">COLOR_BREAK</span><span class="p">:</span>
|
|
<span class="c1"># turn right</span>
|
|
<span class="n">drive</span><span class="p">(</span><span class="n">DRIVE_SPEED</span><span class="p">,</span> <span class="o">-</span><span class="n">DRIVE_SPEED</span><span class="p">)</span>
|
|
<span class="k">else</span><span class="p">:</span>
|
|
<span class="c1"># straight</span>
|
|
<span class="n">drive</span><span class="p">(</span><span class="n">DRIVE_SPEED</span><span class="p">,</span> <span class="n">DRIVE_SPEED</span><span class="p">)</span>
|
|
|
|
<span class="k">if</span> <span class="n">sensors</span><span class="p">[</span><span class="mi">0</span><span class="p">]</span> <span class="o">></span> <span class="n">COLOR_BREAK</span> <span class="ow">and</span> <span class="n">sensors</span><span class="p">[</span><span class="mi">4</span><span class="p">]</span> <span class="o">></span> <span class="n">COLOR_BREAK</span><span class="p">:</span>
|
|
<span class="k">break</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="mi">1</span><span class="p">)</span>
|
|
|
|
<span class="k">def</span> <span class="nf">main</span><span class="p">():</span>
|
|
<span class="n">follow</span><span class="p">()</span>
|
|
|
|
<span class="n">drive</span><span class="p">(</span><span class="n">DRIVE_SPEED</span><span class="p">,</span> <span class="n">DRIVE_SPEED</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.5</span><span class="p">)</span>
|
|
<span class="n">follow</span><span class="p">()</span>
|
|
|
|
<span class="n">drive</span><span class="p">(</span><span class="n">DRIVE_SPEED</span><span class="p">,</span> <span class="n">DRIVE_SPEED</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.5</span><span class="p">)</span>
|
|
<span class="n">follow</span><span class="p">()</span>
|
|
|
|
<span class="n">drive</span><span class="p">(</span><span class="n">DRIVE_SPEED</span><span class="p">,</span> <span class="n">DRIVE_SPEED</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.5</span><span class="p">)</span>
|
|
<span class="n">follow</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="n">main</span><span class="p">()</span>
|
|
</pre></div>
|
|
</div>
|
|
</section>
|
|
<section id="funktionalitat-des-roboters-uberprufen">
|
|
<h2>Funktionalität des Roboters überprüfen<a class="headerlink" href="#funktionalitat-des-roboters-uberprufen" title="Permalink to this heading"></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.Motor</span> <span class="kn">import</span> <span class="n">Motor</span>
|
|
<span class="kn">from</span> <span class="nn">compLib.Encoder</span> <span class="kn">import</span> <span class="n">Encoder</span>
|
|
<span class="kn">from</span> <span class="nn">compLib.IRSensor</span> <span class="kn">import</span> <span class="n">IRSensor</span>
|
|
|
|
|
|
<span class="k">def</span> <span class="nf">testIR</span><span class="p">():</span>
|
|
<span class="nb">print</span><span class="p">(</span><span class="s2">"Enabling Infrared Sensor"</span><span class="p">)</span>
|
|
<span class="n">IRSensor</span><span class="o">.</span><span class="n">enable</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="nb">print</span><span class="p">(</span><span class="s2">"Writing sensor values..."</span><span class="p">)</span>
|
|
<span class="k">for</span> <span class="n">i</span> <span class="ow">in</span> <span class="nb">range</span><span class="p">(</span><span class="mi">0</span><span class="p">,</span> <span class="mi">50</span><span class="p">):</span>
|
|
<span class="nb">print</span><span class="p">(</span><span class="n">IRSensor</span><span class="o">.</span><span class="n">read_all</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.1</span><span class="p">)</span>
|
|
|
|
<span class="nb">print</span><span class="p">(</span><span class="s2">"Disabling Infrared Sensor"</span><span class="p">)</span>
|
|
<span class="n">IRSensor</span><span class="o">.</span><span class="n">disable</span><span class="p">()</span>
|
|
|
|
<span class="k">def</span> <span class="nf">testEncoders</span><span class="p">():</span>
|
|
<span class="n">Motor</span><span class="o">.</span><span class="n">multiple_pulse_width</span><span class="p">((</span><span class="mi">0</span><span class="p">,</span> <span class="mi">50</span><span class="p">),</span> <span class="p">(</span><span class="mi">3</span><span class="p">,</span> <span class="o">-</span><span class="mi">50</span><span class="p">))</span>
|
|
|
|
<span class="nb">print</span><span class="p">(</span><span class="s2">"Writing encoder positions..."</span><span class="p">)</span>
|
|
<span class="k">for</span> <span class="n">i</span> <span class="ow">in</span> <span class="nb">range</span><span class="p">(</span><span class="mi">0</span><span class="p">,</span> <span class="mi">50</span><span class="p">):</span>
|
|
<span class="nb">print</span><span class="p">(</span><span class="n">Encoder</span><span class="o">.</span><span class="n">read_all_positions</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.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">2</span><span class="p">)</span>
|
|
<span class="nb">print</span><span class="p">(</span><span class="s2">"Writing encoder velocities..."</span><span class="p">)</span>
|
|
<span class="k">for</span> <span class="n">i</span> <span class="ow">in</span> <span class="nb">range</span><span class="p">(</span><span class="mi">0</span><span class="p">,</span> <span class="mi">50</span><span class="p">):</span>
|
|
<span class="nb">print</span><span class="p">(</span><span class="n">Encoder</span><span class="o">.</span><span class="n">read_all_velocities</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.1</span><span class="p">)</span>
|
|
|
|
<span class="n">Motor</span><span class="o">.</span><span class="n">multiple_pulse_width</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="p">(</span><span class="mi">3</span><span class="p">,</span> <span class="mi">0</span><span class="p">))</span>
|
|
|
|
|
|
<span class="k">def</span> <span class="nf">testMotors</span><span class="p">():</span>
|
|
<span class="nb">print</span><span class="p">(</span><span class="s2">"Setting pulse_with"</span><span class="p">)</span>
|
|
<span class="n">Motor</span><span class="o">.</span><span class="n">multiple_pulse_width</span><span class="p">((</span><span class="mi">0</span><span class="p">,</span> <span class="mi">50</span><span class="p">),</span> <span class="p">(</span><span class="mi">3</span><span class="p">,</span> <span class="o">-</span><span class="mi">50</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">3</span><span class="p">)</span>
|
|
|
|
<span class="nb">print</span><span class="p">(</span><span class="s2">"Setting power"</span><span class="p">)</span>
|
|
<span class="n">Motor</span><span class="o">.</span><span class="n">multiple_power</span><span class="p">((</span><span class="mi">0</span><span class="p">,</span> <span class="mi">50</span><span class="p">),</span> <span class="p">(</span><span class="mi">3</span><span class="p">,</span> <span class="o">-</span><span class="mi">50</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">3</span><span class="p">)</span>
|
|
|
|
<span class="nb">print</span><span class="p">(</span><span class="s2">"Setting pulse_with"</span><span class="p">)</span>
|
|
<span class="n">Motor</span><span class="o">.</span><span class="n">multiple_speed</span><span class="p">((</span><span class="mi">0</span><span class="p">,</span> <span class="mi">5</span><span class="p">),</span> <span class="p">(</span><span class="mi">3</span><span class="p">,</span> <span class="o">-</span><span class="mi">5</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">3</span><span class="p">)</span>
|
|
|
|
<span class="k">for</span> <span class="n">i</span> <span class="ow">in</span> <span class="nb">range</span><span class="p">(</span><span class="mi">0</span><span class="p">,</span> <span class="mi">100</span><span class="p">):</span>
|
|
<span class="n">Motor</span><span class="o">.</span><span class="n">multiple_power</span><span class="p">((</span><span class="mi">0</span><span class="p">,</span> <span class="n">i</span><span class="p">),</span> <span class="p">(</span><span class="mi">3</span><span class="p">,</span> <span class="o">-</span><span class="n">i</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.1</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="nb">print</span><span class="p">(</span><span class="s2">"Make sure robot is turned on it's back!"</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">5</span><span class="p">)</span>
|
|
|
|
<span class="nb">print</span><span class="p">()</span>
|
|
<span class="nb">print</span><span class="p">(</span><span class="s2">"----------------- Testing Infrared Sensor -----------------"</span><span class="p">)</span>
|
|
<span class="n">testIR</span><span class="p">()</span>
|
|
|
|
<span class="nb">print</span><span class="p">()</span>
|
|
<span class="nb">print</span><span class="p">(</span><span class="s2">"----------------- Testing Encoder -----------------"</span><span class="p">)</span>
|
|
<span class="n">testEncoders</span><span class="p">()</span>
|
|
|
|
<span class="nb">print</span><span class="p">()</span>
|
|
<span class="nb">print</span><span class="p">(</span><span class="s2">"----------------- Testing Motors -----------------"</span><span class="p">)</span>
|
|
<span class="n">testMotors</span><span class="p">()</span>
|
|
</pre></div>
|
|
</div>
|
|
</section>
|
|
</section>
|
|
|
|
|
|
</div>
|
|
</div>
|
|
<footer><div class="rst-footer-buttons" role="navigation" aria-label="Footer">
|
|
<a href="../faq.html" class="btn btn-neutral float-left" title="FAQ" accesskey="p" rel="prev"><span class="fa fa-arrow-circle-left" aria-hidden="true"></span> Zurück</a>
|
|
<a href="../lib/index.html" class="btn btn-neutral float-right" title="compLib" accesskey="n" rel="next">Weiter <span class="fa fa-arrow-circle-right" aria-hidden="true"></span></a>
|
|
</div>
|
|
|
|
<hr/>
|
|
|
|
<div role="contentinfo">
|
|
<p>© Copyright 2022, Verein zur Förderung von Wissenschaft und Technik an Schulen (F-WuTS).</p>
|
|
</div>
|
|
|
|
Erstellt mit <a href="https://www.sphinx-doc.org/">Sphinx</a> mit einem
|
|
<a href="https://github.com/readthedocs/sphinx_rtd_theme">theme</a>
|
|
bereitgestellt von <a href="https://readthedocs.org">Read the Docs</a>.
|
|
|
|
|
|
</footer>
|
|
</div>
|
|
</div>
|
|
</section>
|
|
</div>
|
|
<script>
|
|
jQuery(function () {
|
|
SphinxRtdTheme.Navigation.enable(true);
|
|
});
|
|
</script>
|
|
|
|
</body>
|
|
</html> |