6.示例- RoboDK API文档</t我tle> <link rel="stylesheet" href="//m.sinclairbody.com/doc/en/PythonAPI/_static/css/theme.css" type="text/css"> <link rel="stylesheet" href="//m.sinclairbody.com/doc/en/PythonAPI/_static/pygments.css" type="text/css"> <link rel="stylesheet" href="//m.sinclairbody.com/doc/en/PythonAPI/_static/pygments.css" type="text/css"> <link rel="stylesheet" href="//m.sinclairbody.com/doc/en/PythonAPI/_static/css/theme.css" type="text/css"> </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="//m.sinclairbody.com/doc/en/PythonAPI/index.html" class="icon icon-home">RoboDK API<我米gsrc="//m.sinclairbody.com/doc/en/PythonAPI/_static/weblogo.svg" class="logo" alt="标志＂></一个><div class="version"> 5.5</gydF4y2Badiv> <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="是的＂><我nput type="hidden" name="area" value="默认的＂></f或米></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="//m.sinclairbody.com/doc/en/PythonAPI/intro.html">1.简介</一个></li> <li class="toctree-l1"><a class="reference internal" href="//m.sinclairbody.com/doc/en/PythonAPI/robodk.html">2.RoboDK API (RoboDK包)</一个></li> <li class="toctree-l1"><a class="reference internal" href="//m.sinclairbody.com/doc/en/PythonAPI/postprocessor.html">3.后处理器</一个></li> <li class="toctree-l1"><a class="reference internal" href="//m.sinclairbody.com/doc/en/PythonAPI/driver.html">4.司机</一个></li> <li class="toctree-l1"><a class="reference internal" href="//m.sinclairbody.com/doc/en/PythonAPI/app.html">5.应用程序</一个></li> <li class="toctree-l1 current"><a class="current reference internal" href="#">6.例子</一个><ul> <li class="toctree-l2"><a class="reference internal" href="#offline-programming">6.1.2022世界杯8强赛时间离线编程</一个></li> <li class="toctree-l2"><a class="reference internal" href="#offline-programming-gui">6.2.2022世界杯8强赛时间离线编程(GUI)</一个></li> <li class="toctree-l2"><a class="reference internal" href="#online-programming">6.3.在线编程</一个></li> <li class="toctree-l2"><a class="reference internal" href="#points-to-program">6.4.项目要点</一个></li> <li class="toctree-l2"><a class="reference internal" href="#points-to-curve">6.5.曲线点</一个></li> <li class="toctree-l2"><a class="reference internal" href="#csv-file-to-program-xyz">6.6.CSV文件到程序(XYZ)</一个></li> <li class="toctree-l2"><a class="reference internal" href="#csv-file-to-program-xyzwpr">6.7.CSV文件到程序(XYZWPR)</一个></li> <li class="toctree-l2"><a class="reference internal" href="#load-a-kuka-src-file">6.8.加载一个KUKA SRC文件</一个></li> <li class="toctree-l2"><a class="reference internal" href="#test-move-feasibility">6.9.测试移动可行性</一个></li> <li class="toctree-l2"><a class="reference internal" href="#docked-ui">6.10.对接界面</一个></li> <li class="toctree-l2"><a class="reference internal" href="#estimated-cycle-time">6.11.预计周期时间</一个></li> <li class="toctree-l2"><a class="reference internal" href="#change-tool">6.12.改变工具</一个></li> <li class="toctree-l2"><a class="reference internal" href="#project-curve-to-surface">6.13.投影曲线到曲面</一个></li> <li class="toctree-l2"><a class="reference internal" href="#filter-curve-normals">6.14.滤波曲线法线</一个></li> <li class="toctree-l2"><a class="reference internal" href="#change-curve-normals">6.15.变化曲线法线</一个></li> <li class="toctree-l2"><a class="reference internal" href="#attach-object-to-a-robot-link">6.16.将对象附加到机器人链接</一个></li> <li class="toctree-l2"><a class="reference internal" href="#move-robot-using-a-keyboard">6.17.使用键盘移动机器人</一个></li> <li class="toctree-l2"><a class="reference internal" href="#connect-to-robots">6.18.连接到机器人</一个></li> <li class="toctree-l2"><a class="reference internal" href="#monitor-joints">6.19.监控关节</一个></li> <li class="toctree-l2"><a class="reference internal" href="#monitor-a-real-ur-robot">6.20.监控一个真实的UR机器人</一个></li> <li class="toctree-l2"><a class="reference internal" href="#pick-and-place">6.21.挑选和放置</一个></li> <li class="toctree-l2"><a class="reference internal" href="#update-machining-tools">6.22.更新加工工具</一个></li> <li class="toctree-l2"><a class="reference internal" href="#project-tcp-to-axis">6.23.项目TCP到Axis</一个></li> <li class="toctree-l2"><a class="reference internal" href="#robot-machining-settings">6.24.机器人加工设置</一个></li> <li class="toctree-l2"><a class="reference internal" href="#axes-optimization-settings">6.25.优化设置</一个></li> <li class="toctree-l2"><a class="reference internal" href="#modify-program-instructions">6.26.修改程序说明</一个></li> <li class="toctree-l2"><a class="reference internal" href="#drawing-an-svg-image">6.27.绘制SVG图像</一个></li> <li class="toctree-l2"><a class="reference internal" href="#synchronize-3-robots">6.28.同步3机器人</一个></li> <li class="toctree-l2"><a class="reference internal" href="#robot-model-dh">6.29.机器人模型(DH)</一个></li> <li class="toctree-l2"><a class="reference internal" href="#camera-live-stream">6.30.摄像头直播</一个></li> <li class="toctree-l2"><a class="reference internal" href="#camera-calibration">6.31.摄像机标定</一个></li> <li class="toctree-l2"><a class="reference internal" href="#camera-pose">6.32.相机的姿势</一个></li> <li class="toctree-l2"><a class="reference internal" href="#augmented-reality">6.33.增强现实</一个></li> <li class="toctree-l2"><a class="reference internal" href="#qr-codes-and-barcodes">6.34.二维码和条形码</一个><ul> <li class="toctree-l3"><a class="reference internal" href="#generating-qr-codes">6.34.1.生成二维码</一个></li> <li class="toctree-l3"><a class="reference internal" href="#generating-barcodes-ean-13">6.34.2.生成条形码(EAN-13)</一个></li> <li class="toctree-l3"><a class="reference internal" href="#reading-qr-codes-and-bar-codes">6.34.3.阅读二维码和条形码</一个></li> </ul></li> <li class="toctree-l2"><a class="reference internal" href="#object-detection">6.35.对象检测</一个><ul> <li class="toctree-l3"><a class="reference internal" href="#d-pose-estimation-of-a-known-object">6.35.1.已知物体的二维姿态估计</一个></li> <li class="toctree-l3"><a class="reference internal" href="#blob-detection">6.35.2.Blob检测</一个></li> <li class="toctree-l3"><a class="reference internal" href="#orientation-of-elongated-parts">6.35.3.拉长部分的方向</一个></li> </ul></li> <li class="toctree-l2"><a class="reference internal" href="#depth-camera">6.36.深度相机</一个><ul> <li class="toctree-l3"><a class="reference internal" href="#depth-map">6.36.1.深度图</一个></li> <li class="toctree-l3"><a class="reference internal" href="#mesh-reconstruction">6.36.2.网格重建</一个></li> <li class="toctree-l3"><a class="reference internal" href="#rgb-d-livestream">6.36.3.RGB-D转播画面</一个></li> </ul></li> </ul></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="//m.sinclairbody.com/doc/en/PythonAPI/index.html">RoboDK API</一个></n一个v> <div class="wy-nav-content"> <div class="rst-content"> <div role="navigation" aria-label="breadcrumbs navigation"> <ul class="wy-breadcrumbs"> <li><a href="//m.sinclairbody.com/doc/en/PythonAPI/index.html" class="icon icon-home"></a>»</gydF4y2Bali> <li><span class="section-number">6.</gydF4y2Baspan>例子</gydF4y2Bali> <li class="wy-breadcrumbs-aside"></li> </ul> <hr> </div> <div role="main" class="document" itemscope itemtype="http://schema.org/Article"> <div itemprop="articleBody"> <div class="section" id="examples"> <span id="id1"></span> <h1><span class="section-number">6.</gydF4y2Baspan>例子<一个class="headerlink" href="#examples" title="¶＂>gydF4y2Ba¶</一个></h1><p>本节将展示一些使用RoboDK API的Python示例。这些示例中的大多数都可以轻松地移植到其他编程语言(如c#、c++、. net或Matlab)。这些例子是使用Python 3测试的，可能需要一些调整才能在Python 2上工作。</p><p>gydF4y2Ba其他RoboDK API示例包含在以下文件夹中:</p><b锁问uote> <div> <ul class="simple"> <li><p>C: / / RoboDK /图书馆/脚本</p></gydF4y2Bali> <li><p>C: / RoboDK /图书馆/宏/</p></gydF4y2Bali> </ul> </div> </blockquote> <p>Scripts文件夹中的任何Python文件都可以作为独立脚本运行，请选择:</p><b锁问uote> <div> <ul class="simple"> <li><p>工具涉及脚本</p></gydF4y2Bali> <li><p>选择脚本来运行它</p></gydF4y2Bali> </ul> </div> </blockquote> <p>在RoboDK库中提供的示例RoboDK项目(RDK文件)中使用了一些示例。GitHub上也有一些例子:<一个class="reference external" href="https://github.com/RoboDK/RoboDK-API/tree/master/Python/Examples">https://github.com/RoboDK/RoboDK-API/tree/master/Python/Examples</一个>．</p><gydF4y2Badiv class="section" id="offline-programming"> <span id="weldexample"></span> <h2><span class="section-number">6.1.</gydF4y2Baspan>2022世界杯8强赛时间<a class="headerlink" href="#offline-programming" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子展示了如何生成给定一个目标的六边形路径。这个宏使用RoboDK API为Python绘制一个半径为R和n_sides顶点的多边形。</p><gydF4y2Badl class="simple"> <dt> 更多信息请点击这里:</gydF4y2Badt> <dd> <ul class="simple"> <li><p>2022世界杯8强赛时间RoboDK离线编程:<一个class="reference external" href="//m.sinclairbody.com/offline-programming">//m.sinclairbody.com/offline-programming</一个></p></li> <li><p>使用RoboDK API进行Python仿真:<一个class="reference external" href="//m.sinclairbody.com/doc/en/RoboDK-API.html">//m.sinclairbody.com/doc/en/RoboDK-API.html#PythonAPIOLP</一个></p></li> <li><p>后处理器:<一个class="reference external" href="//m.sinclairbody.com/doc/en/Post-Processors.html">//m.sinclairbody.com/doc/en/Post-Processors.html#PostProcessor</一个></p></li> <li><p>2022世界杯8强赛时间离线编程概述:<一个class="reference external" href="https://www.youtube.com/watch?list=PLjiA6TvRACQc5E_3c5f3TFXEa56XNR1-m&v=Ic-iKGSc7dk">https://www.youtube.com/watch?list=PLjiA6TvRACQc5E_3c5f3TFXEa56XNR1-m&v=Ic-iKGSc7dk</一个></p></li> </ul> </dd> </dl> <div class="literal-block-wrapper docutils container" id="offline-programming-weld-test"> <div class="code-block-caption"> <span class="caption-text">2022世界杯8强赛时间离线编程-焊接测试</gydF4y2Baspan> <a class="headerlink" href="#offline-programming-weld-test" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">这个宏展示了一个使用RoboDK API for Python绘制半径为R和n个顶点的多边形的例子</gydF4y2Baspan><span class="c1">更多关于RoboDK API的信息:</gydF4y2Baspan><span class="c1"># //m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># API与RoboDK通信</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robomath</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">基本矩阵运算</gydF4y2Baspan><span class="c1">#任何与RoboDK的交互都必须通过RDK完成:</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#选择一个机器人(如果有一个以上的机器人会弹出)</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemUserPick</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“选择一个机器人”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_ROBOT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“没有选定或可用的机器人”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">获取TCP相对于参考系的当前位置:</gydF4y2Baspan><span class="c1"># (4x4矩阵表示位置和方向)</gydF4y2Baspan><span class="n">target_ref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">pos_ref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">target_ref</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Pos</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“围绕目标绘制多边形:”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">Pose_2_TxyzRxyz</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">target_ref</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="c1">#移动机器人到第一个点:</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">target_ref</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">离线生成程序时，提供参考框架和工具框架是很重要的</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">PoseFrame</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseTool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">PoseTool</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setRounding</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">10</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#设置舍入参数(也称为:CNT, APO/C_DIS, zondata，混合半径，转角，…)</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setSpeed</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">200</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#设置线速度，单位为mm/s</gydF4y2Baspan><span class="c1">#设置多边形的边数:</gydF4y2Baspan><span class="n">n_sides</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">6</gydF4y2Baspan><span class="n">R</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="c1">#在参考目标周围做一个六边形:</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">n_sides</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">盎</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="n">n_sides</gydF4y2Baspan><span class="c1">#角度:0,60,120，…</gydF4y2Baspan><span class="c1">#-----------------------------</gydF4y2Baspan><span class="c1">相对于参考系的移动</gydF4y2Baspan><span class="c1">#创建目标的副本</gydF4y2Baspan><span class="n">target_i</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">垫</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">target_ref</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">pos_i</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">target_i</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Pos</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">pos_i</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">pos_i</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">R</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">因为</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">盎</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">pos_i</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">pos_i</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">R</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">罪</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">盎</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">target_i</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPos</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">pos_i</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“转向目标</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s2">:角</gydF4y2Baspan><span class="si">% .1f</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">盎</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="mi">180</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">str</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">Pose_2_TxyzRxyz</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">target_i</gydF4y2Baspan><span class="p">）））</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">target_i</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#-----------------------------</gydF4y2Baspan><span class="c1"># Post multiply:相对于工具</gydF4y2Baspan><span class="c1">#target_i = target_ref * rotz(ang) * transl(R,0,0) * rotz(-ang)</gydF4y2Baspan><span class="c1"># robot.MoveL (target_i)</gydF4y2Baspan><span class="c1">#回到中心，然后回家:</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">target_ref</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“完成”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="offline-programming-gui"> <h2><span class="section-number">6.2.</gydF4y2Baspan>2022世界杯8强赛时间离线编程(GUI)<一个class="headerlink" href="#offline-programming-gui" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子是前一个例子的改进版本。在模拟或生成程序之前，它会提示用户输入一些内容。这个例子展示了RoboDK和Python GUI tkinter如何显示图形用户界面，以根据某些参数自定义程序生成。</p><gydF4y2Badl class="simple"> <dt> 更多信息请点击这里:</gydF4y2Badt> <dd> <ul class="simple"> <li><p>使用RoboDK API进行Python仿真:<一个class="reference external" href="//m.sinclairbody.com/doc/en/RoboDK-API.html">//m.sinclairbody.com/doc/en/RoboDK-API.html#PythonAPIOLP</一个></p></li> <li><p>后处理器:<一个class="reference external" href="//m.sinclairbody.com/doc/en/Post-Processors.html">//m.sinclairbody.com/doc/en/Post-Processors.html#PostProcessor</一个></p></li> </ul> </dd> </dl> <div class="literal-block-wrapper docutils container" id="offline-programming-with-gui"> <div class="code-block-caption"> <span class="caption-text">2022世界杯8强赛时间使用GUI进行离线编程</gydF4y2Baspan> <a class="headerlink" href="#offline-programming-with-gui" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">#这个例子展示了RoboDK和Python GUI tkinter如何显示图形用户界面，以根据某些参数自定义程序生成</gydF4y2Baspan><span class="c1">这个例子是焊接六边形的改进</gydF4y2Baspan><span class="c1">更多关于RoboDK API的信息:</gydF4y2Baspan><span class="c1"># //m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># API与RoboDK通信</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robomath</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># robodk机器人工具箱</gydF4y2Baspan><span class="c1">#设置默认参数</gydF4y2Baspan><span class="n">PROGRAM_NAME</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s2">“DoWeld”</gydF4y2Baspan><span class="c1">#程序名称</gydF4y2Baspan><span class="n">方法</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">300</gydF4y2Baspan><span class="c1">#接近距离</gydF4y2Baspan><span class="n">半径</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">200</gydF4y2Baspan><span class="c1">#多边形半径</gydF4y2Baspan><span class="n">SPEED_WELD</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">50</gydF4y2Baspan><span class="c1">焊接路径的速度以mn/s为单位</gydF4y2Baspan><span class="n">SPEED_MOVE</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">200</gydF4y2Baspan><span class="c1">进/退运动的速度(以毫米/秒为单位)</gydF4y2Baspan><span class="n">国</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">8</gydF4y2Baspan><span class="c1">#多边形的边数</gydF4y2Baspan><span class="n">DRY_RUN</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">#如果为0，将生成SprayOn/SprayOff程序调用，否则将不激活工具</gydF4y2Baspan><span class="n">RUN_MODE</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RUNMODE_SIMULATE</gydF4y2Baspan><span class="c1">#模拟行为(模拟、生成程序或生成程序并发送给机器人)</gydF4y2Baspan><span class="c1">仅使用RUNMODE_SIMULATE进行模拟</gydF4y2Baspan><span class="c1">使用RUNMODE_MAKE_ROBOTPROG生成程序</gydF4y2Baspan><span class="c1">使用RUNMODE_MAKE_ROBOTPROG_AND_UPLOAD生成程序并将其发送给机器人</gydF4y2Baspan><span class="c1">#主程序</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">调用</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="c1">使用默认全局变量</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">PROGRAM_NAME</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">方法</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">半径</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">SPEED_WELD</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">SPEED_MOVE</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">国</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">DRY_RUN</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">RUN_MODE</gydF4y2Baspan><span class="c1">#任何与RoboDK的交互都必须通过RDK完成:</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#获得主目标和焊接目标:</gydF4y2Baspan><span class="n">首页</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“回家”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“目标参考”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#将机器人作为物品:</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_ROBOT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#强制运行模式</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setRunMode</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">RUN_MODE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#设置生成程序的名称</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ProgramStart</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">PROGRAM_NAME</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">＂＂</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">＂＂</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#获取参考目标的姿态(4x4矩阵表示位置和方向):</gydF4y2Baspan><span class="n">poseref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#移动机器人到home，然后到接近位置</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">首页</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setSpeed</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">SPEED_MOVE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">方法</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">poseref</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#在参考目标周围创建n个边的多边形</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">国</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">盎</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="n">国</gydF4y2Baspan><span class="c1">#角度:0,60,120，…</gydF4y2Baspan><span class="c1">#计算下一个位置</gydF4y2Baspan><span class="n">posei</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">poseref</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">rotz</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">盎</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">半径</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">rotz</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">盎</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">posei</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#只对第一点施加焊接速度</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#设置焊接速度，到达第一个点后启动焊枪</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setSpeed</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">SPEED_WELD</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">DRY_RUN</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#到达第一个点后立即启动喷雾器</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">RunCodeCustom</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“SprayOn”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">INSTRUCTION_CALL_PROGRAM</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#停止工具，如果我们没有做一个演练</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">DRY_RUN</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">RunCodeCustom</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“SprayOff”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">INSTRUCTION_CALL_PROGRAM</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setSpeed</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">SPEED_MOVE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#回到接近点，然后回家:</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">方法</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">poseref</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">首页</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#触发程序生成(RDK完成时自动生成)</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">完成</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#使用tkinter显示GUI菜单</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">tkinter</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">#生成主窗口</gydF4y2Baspan><span class="n">根</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Tk</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">根</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">标题</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“项目设置”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">使用链接到全局变量的变量</gydF4y2Baspan><span class="n">runmode</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">IntVar</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">runmode</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">集</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">RUN_MODE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#设置默认值</gydF4y2Baspan><span class="n">dryrun</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">IntVar</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">dryrun</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">集</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">DRY_RUN</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#设置默认值</gydF4y2Baspan><span class="n">entry_name</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">StringVar</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">entry_name</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">集</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">PROGRAM_NAME</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">entry_speed</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">StringVar</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">entry_speed</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">集</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">str</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">SPEED_WELD</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="c1">#定义反馈电话</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">ShowRunMode</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">"选定运行模式:"</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="nb">str</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">runmode</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">得到</gydF4y2Baspan><span class="p">()))</gydF4y2Baspan><span class="c1">为程序名称定义标签和输入文本</gydF4y2Baspan><span class="n">标签</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">根</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">文本</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s2">“项目名称”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">包</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">条目</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">根</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">textvariable</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">entry_name</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">包</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">定义焊接速度的标签和输入文本</gydF4y2Baspan><span class="n">标签</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">根</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">文本</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s2">焊接速度(mm/s)</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">包</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">条目</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">根</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">textvariable</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">entry_speed</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">包</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#定义一个复选框来进行演练</gydF4y2Baspan><span class="n">Checkbutton</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">根</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">文本</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s2">“演习”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">变量</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">dryrun</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">onvalue</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">offvalue</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">高度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">5</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">宽度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">20.</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">包</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">为运行模式添加一个显示标签</gydF4y2Baspan><span class="n">标签</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">根</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">文本</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s2">“运行模式”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">证明</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">左</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">padx</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">20.</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">包</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#设置运行模式(单选按钮)</gydF4y2Baspan><span class="n">runmodes</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">((</gydF4y2Baspan><span class="s2">“模拟”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">RUNMODE_SIMULATE</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“生成程序”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">RUNMODE_MAKE_ROBOTPROG</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“给机器人发送程序”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">RUNMODE_MAKE_ROBOTPROG_AND_START</gydF4y2Baspan><span class="p">)]</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">三种</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">瓦尔</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">runmodes</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">Radiobutton</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">根</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">文本</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">三种</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">padx</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">20.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">变量</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">runmode</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">命令</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">ShowRunMode</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">瓦尔</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">包</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">锚</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">W</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#添加一个按钮和默认动作来执行用户的当前选择</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">ExecuteChoice</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">DRY_RUN</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">RUN_MODE</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">SPEED_WELD</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">PROGRAM_NAME</gydF4y2Baspan><span class="n">DRY_RUN</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">dryrun</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">得到</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">RUN_MODE</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">runmode</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">得到</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">SPEED_WELD</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">浮动</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">entry_speed</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">得到</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="n">PROGRAM_NAME</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">entry_name</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">得到</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#设置完所有全局变量后，运行主程序</gydF4y2Baspan><span class="n">调用</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">按钮</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">根</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">文本</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“模拟/生成”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">命令</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">ExecuteChoice</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">包</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#显示图形用户界面很重要</gydF4y2Baspan><span class="n">根</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">mainloop</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="online-programming"> <h2><span class="section-number">6.3.</gydF4y2Baspan>在线编程<一个class="headerlink" href="#online-programming" title="¶＂>gydF4y2Ba¶</一个></h2><p>此示例是前两个示例的修改版本，支持直接从脚本在机器人上运行程序。这个例子将从Python API(在线编程)在机器人上运行一个Python程序。如果将机器人连接到PC上，在Python程序执行的同时，仿真机器人和真实机器人将同时移动。同样的程序也可以用于模拟或脱机编程。2022世界杯8强赛时间</p><gydF4y2Badl class="simple"> <dt> 更多信息请点击这里:</gydF4y2Badt> <dd> <ul class="simple"> <li><p>使用RoboDK API为Python进行在线编程:<一个class="reference external" href="//m.sinclairbody.com/doc/en/RoboDK-API.html">//m.sinclairbody.com/doc/en/RoboDK-API.html#PythonAPIOnline</一个></p></li> <li><p>机器人司机:<一个class="reference external" href="//m.sinclairbody.com/doc/en/Robot-Drivers.html">//m.sinclairbody.com/doc/en/Robot-Drivers.html#RobotDrivers</一个></p></li> </ul> </dd> </dl> <div class="literal-block-wrapper docutils container" id="id2"> <div class="code-block-caption"> <span class="caption-text">在线编程</gydF4y2Baspan> <a class="headerlink" href="#id2" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">这个宏显示了一个从Python API(在线编程)在机器人上运行程序的示例</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">#重要:默认情况下，在RoboDK API上右键单击一个程序并选择“Run on Robot”具有与运行本示例相同的效果。</gydF4y2Baspan><span class="c1">如果程序是从RoboDK站树中运行的，请使用Example_OnlineProgramming.py</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">这个例子通过以下命令强制连接到机器人:</gydF4y2Baspan><span class="c1"># robot.Connect ()</gydF4y2Baspan><span class="c1">#和</gydF4y2Baspan><span class="c1"># RDK.setRunMode (RUNMODE_RUN_ROBOT)</gydF4y2Baspan><span class="c1">在这个脚本中，如果变量RUN_ON_ROBOT被设置为True，将尝试连接到机器人</gydF4y2Baspan><span class="c1">或者，如果RUN_ON_ROBOT变量设置为False，程序将被模拟(脱机编程)2022世界杯8强赛时间</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">更多关于RoboDK API的信息:</gydF4y2Baspan><span class="c1"># //m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># API与RoboDK通信</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robomath</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">基本矩阵运算</gydF4y2Baspan><span class="c1">#任何与RoboDK的交互都必须通过RDK完成:</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#选择一个机器人(如果有一个以上的机器人会弹出)</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemUserPick</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“选择一个机器人”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_ROBOT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“没有选定或可用的机器人”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">RUN_ON_ROBOT</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="c1">#重要提示:默认情况下，运行模式为RUNMODE_SIMULATE</gydF4y2Baspan><span class="c1">如果程序是离线手动生成的，则运行模式为RUNMODE_MAKE_ROBOTPROG。</gydF4y2Baspan><span class="c1">因此，我们不应该在机器人上运行程序</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">RunMode</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="n">RUNMODE_SIMULATE</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">RUN_ON_ROBOT</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">RUN_ON_ROBOT</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">如果需要更新连接参数:</gydF4y2Baspan><span class="c1"># robot.setConnectionParams('192.168.2.35'，30000，'/'， 'anonymous'， ")</gydF4y2Baspan><span class="c1">使用默认IP连接到机器人</gydF4y2Baspan><span class="n">成功</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">连接</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">试着联系一次</gydF4y2Baspan><span class="c1">#success robot.ConnectSafe() #尝试多次连接</gydF4y2Baspan><span class="n">状态</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">status_msg</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ConnectedState</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">状态</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="n">ROBOTCOM_READY</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">如果连接不成功，请停止</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">status_msg</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">"连接失败:"</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">status_msg</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#这将设置在机器人和模拟器上运行API程序(在线编程)</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setRunMode</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">RUNMODE_RUN_ROBOT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#注意:当我们通过API将Connect()连接到机器人时，这是自动设置的</gydF4y2Baspan><span class="c1">其他:</gydF4y2Baspan><span class="c1">#这将在模拟器上运行API程序(离线编程)2022世界杯8强赛时间</gydF4y2Baspan><span class="c1"># RDK.setRunMode (RUNMODE_SIMULATE)</gydF4y2Baspan><span class="c1">#注意:这是默认设置，如果我们不执行robot.Connect()</gydF4y2Baspan><span class="c1">如果我们希望能够离线生成机器人程序，我们不应该设置RUNMODE_SIMULATE</gydF4y2Baspan><span class="c1">#获取机器人当前关节位置</gydF4y2Baspan><span class="c1">#(更新机器人模拟器的位置)</gydF4y2Baspan><span class="n">joints_ref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">获取TCP相对于参考系的当前位置:</gydF4y2Baspan><span class="c1"># (4x4矩阵表示位置和方向)</gydF4y2Baspan><span class="n">target_ref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">pos_ref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">target_ref</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Pos</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“围绕目标绘制多边形:”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">Pose_2_TxyzRxyz</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">target_ref</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="c1">#移动机器人到第一个点:</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">target_ref</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">离线生成程序时，提供参考框架和工具框架是很重要的</gydF4y2Baspan><span class="c1">在使用驱动程序时，更新机器人上的TCP是很重要的</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">PoseFrame</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseTool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">PoseTool</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setRounding</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">10</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#设置舍入参数(也称为:CNT, APO/C_DIS, zondata，混合半径，转角，…)</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setSpeed</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">200</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#设置线速度，单位为mm/s</gydF4y2Baspan><span class="c1">#设置多边形的边数:</gydF4y2Baspan><span class="n">n_sides</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">6</gydF4y2Baspan><span class="n">R</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="c1">#在参考目标周围做一个六边形:</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">n_sides</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">盎</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="n">n_sides</gydF4y2Baspan><span class="c1">#角度:0,60,120，…</gydF4y2Baspan><span class="c1">#-----------------------------</gydF4y2Baspan><span class="c1">相对于参考系的移动</gydF4y2Baspan><span class="c1">#创建目标的副本</gydF4y2Baspan><span class="n">target_i</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">垫</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">target_ref</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">pos_i</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">target_i</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Pos</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">pos_i</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">pos_i</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">R</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">因为</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">盎</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">pos_i</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">pos_i</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">R</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">罪</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">盎</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">target_i</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPos</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">pos_i</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“转向目标</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s2">:角</gydF4y2Baspan><span class="si">% .1f</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">盎</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="mi">180</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">str</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">Pose_2_TxyzRxyz</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">target_i</gydF4y2Baspan><span class="p">）））</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">target_i</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#-----------------------------</gydF4y2Baspan><span class="c1"># Post multiply:相对于工具</gydF4y2Baspan><span class="c1">#target_i = target_ref * rotz(ang) * transl(R,0,0) * rotz(-ang)</gydF4y2Baspan><span class="c1"># robot.MoveL (target_i)</gydF4y2Baspan><span class="c1">#回到中心，然后回家:</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">target_ref</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“完成”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">从API运行GUI创建的程序的示例</gydF4y2Baspan><span class="c1">#prog = RDK。项（＇MainProgram', ITEM_TYPE_PROGRAM)</span><span class="c1">## program . setruntype (PROGRAM_RUN_ON_ROBOT</gydF4y2Baspan><span class="c1">#在模拟器上运行(默认在启动时)</gydF4y2Baspan><span class="c1"># prog.RunProgram ()</gydF4y2Baspan><span class="c1">#while prog.Busy() == 1:</gydF4y2Baspan><span class="c1">#暂停(0.1)</gydF4y2Baspan><span class="c1">#打印(“项目完成”)</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="points-to-program"> <span id="lbl-move-through-points"></span> <h2><span class="section-number">6.4.</gydF4y2Baspan>项目要点<一个class="headerlink" href="#points-to-program" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子展示了沿着一组点移动机器人的不同方式。</p><gydF4y2Badiv class="literal-block-wrapper docutils container" id="move-robot-through-points"> <div class="code-block-caption"> <span class="caption-text">移动机器人通过点</gydF4y2Baspan> <a class="headerlink" href="#move-robot-through-points" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">#在给定起点和终点的直线上按步移动机器人</gydF4y2Baspan><span class="c1">这个宏展示了使用Python脚本和RoboDK API编程机器人的三种不同方式</gydF4y2Baspan><span class="c1">更多关于RoboDK API的信息:</gydF4y2Baspan><span class="c1"># //m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">更多信息请访问:</gydF4y2Baspan><span class="c1"># //m.sinclairbody.com/doc/en/PythonAPI/robodk.html robolink-py</gydF4y2Baspan><span class="c1">#默认参数:</gydF4y2Baspan><span class="n">P_START</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1755</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">500</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">2155</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1">#相对于机器人基础框架的起始点</gydF4y2Baspan><span class="n">P_END</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1755</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">600</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">2155</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1">端点相对于机器人基础框架</gydF4y2Baspan><span class="n">NUM_POINTS</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">10</gydF4y2Baspan><span class="c1">要插值的点的数量</gydF4y2Baspan><span class="c1">#函数定义创建一个点列表(行)</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">MakePoints</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">xStart</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">xEnd</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">numPoints</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""生成点列表""" "</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">xStart</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">xEnd</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">"起点和终点必须是三维向量"</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">numPoints</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“至少需要两点”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#起点</gydF4y2Baspan><span class="n">pt_list</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［］</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">xStart</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">y</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">xStart</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">z</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">xStart</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1">我们在每个插值点之间加/减多少</gydF4y2Baspan><span class="n">x_steps</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">xEnd</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">xStart</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">numPoints</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">y_steps</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">xEnd</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">xStart</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">numPoints</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">z_steps</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">xEnd</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">xStart</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">numPoints</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#逐步添加到每个点，直到到达终点</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">numPoints</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">point_i</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">y</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">z</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1">#创建一个点</gydF4y2Baspan><span class="c1">#添加点到列表中</gydF4y2Baspan><span class="n">pt_list</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">point_i</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">x_steps</gydF4y2Baspan><span class="n">y</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">y</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">y_steps</gydF4y2Baspan><span class="n">z</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">z</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">z_steps</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="n">pt_list</gydF4y2Baspan><span class="c1">#---------------------------------------------------</gydF4y2Baspan><span class="c1">#--------------- 程序开始 ---------------------</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># API与RoboDK通信</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robomath</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">基本矩阵运算</gydF4y2Baspan><span class="c1">#生成点曲线路径</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">MakePoints</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">P_START</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">P_END</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">NUM_POINTS</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#初始化RoboDK API</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#关闭自动渲染(更快)</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">渲染</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#自动删除之前生成的项目(自动标记)</gydF4y2Baspan><span class="n">list_names</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemList</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">列出所有名字</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">item_name</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">list_names</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">item_name</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">startswith</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“汽车”</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">item_name</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">删除</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#提示用户选择一个机器人(如果只有一个机器人可用，它将自动选择该机器人)</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemUserPick</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“选择一个机器人”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_ROBOT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#在开始模拟之前打开渲染</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">渲染</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">如果用户点击取消，#终止</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#检索机器人参考系</gydF4y2Baspan><span class="n">参考</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">父</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#使用机器人基本框架作为活动参考</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参考</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#获取机器人的当前方向(相对于活动参考系和工具架)</gydF4y2Baspan><span class="n">pose_ref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">Pose_2_TxyzRxyz</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">pose_ref</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="c1"># a pose也可以定义为xyzwpr / xyzABC</gydF4y2Baspan><span class="c1">#pose_ref = TxyzRxyz_2_Pose([100,200,300,0,0,pi])</gydF4y2Baspan><span class="c1">#-------------------------------------------------------------</gydF4y2Baspan><span class="c1">#选项1:使用Python脚本移动机器人</gydF4y2Baspan><span class="c1">#我们可以使用RUNMODE状态自动强制“创建机器人程序”动作</gydF4y2Baspan><span class="c1"># RDK.setRunMode (RUNMODE_MAKE_ROBOTPROG)</gydF4y2Baspan><span class="c1">遍历所有点</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">NUM_POINTS</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="c1">使用所需的XYZ坐标更新引用目标</gydF4y2Baspan><span class="n">pose_i</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">pose_ref</gydF4y2Baspan><span class="n">pose_i</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPos</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="c1">#移动机器人到目标:</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">pose_i</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#完成，停止程序执行</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#-------------------------------------------------------------</gydF4y2Baspan><span class="c1">#选项2:在图形用户界面上创建程序</gydF4y2Baspan><span class="c1">#关闭渲染</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">渲染</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddProgram</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“AutoProgram”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">遍历所有点</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">NUM_POINTS</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="c1">#添加一个新目标，并保持对它的引用</gydF4y2Baspan><span class="n">“透明国际”</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddTarget</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">汽车的目标</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="c1">#使用参考姿态并更新XYZ位置</gydF4y2Baspan><span class="n">pose_i</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">pose_ref</gydF4y2Baspan><span class="n">pose_i</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPos</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="n">“透明国际”</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">pose_i</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#强制使用目标作为笛卡尔目标</gydF4y2Baspan><span class="n">“透明国际”</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setAsCartesianTarget</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#可选地，在新程序中添加目标作为线性/联合移动</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">“透明国际”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#在开始模拟之前打开渲染</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">渲染</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#在模拟器上运行程序(模拟程序):</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">调用</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1"># prog.WaitFinished() #等待程序完成</gydF4y2Baspan><span class="c1">#我们可以自动创建程序</gydF4y2Baspan><span class="c1"># prog.MakeProgram ()</gydF4y2Baspan><span class="c1">此外，如果我们有机器人驱动程序，我们可以使用下面的调用来触发“运行机器人”动作(模拟和机器人同时移动)</gydF4y2Baspan><span class="c1"># prog.setRunType (PROGRAM_RUN_ON_ROBOT)</gydF4y2Baspan><span class="c1">#完成，停止程序执行</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#-------------------------------------------------------------</gydF4y2Baspan><span class="c1">#选项3:使用Python脚本移动机器人，并检测移动是否可以是线性的</gydF4y2Baspan><span class="c1">#这是选项1的改进版本</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">#我们可以使用RUNMODE状态自动强制“创建机器人程序”动作</gydF4y2Baspan><span class="c1"># RDK.setRunMode (RUNMODE_MAKE_ROBOTPROG)</gydF4y2Baspan><span class="c1">遍历所有点</gydF4y2Baspan><span class="n">ROBOT_JOINTS</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">NUM_POINTS</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="c1">使用所需的XYZ坐标更新引用目标</gydF4y2Baspan><span class="n">pose_i</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">pose_ref</gydF4y2Baspan><span class="n">pose_i</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPos</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="c1">#移动机器人到目标:</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#重要的是:让第一个动作成为一个联合动作!</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">pose_i</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">ROBOT_JOINTS</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="k">其他的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#测试我们是否可以做一个从当前位置到下一个点的线性移动</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL_Collision</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">ROBOT_JOINTS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">pose_i</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">pose_i</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">其他的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">pose_i</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">ROBOT_JOINTS</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#完成，停止程序执行</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#-------------------------------------------------------------</gydF4y2Baspan><span class="c1">#选项4:创建跟随曲线的项目</gydF4y2Baspan><span class="c1">#首先，我们需要从提供的点创建一个对象，或者将点添加到一个现有的对象，并可选地将它们投射到表面上</gydF4y2Baspan><span class="c1">#创建一个新对象，给定点的列表(3xN的向量可以扩展到6xN，以提供法线)</gydF4y2Baspan><span class="n">object_points</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddPoints</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">或者，我们可以在物体表面投影点</gydF4y2Baspan><span class="c1">#对象= RDK。项（＇Object', ITEM_TYPE_OBJECT)</span><span class="c1"># object_points =对象。AddPoints（点，PROJECTION_ALONG_NORMAL_RECALC）</gydF4y2Baspan><span class="c1">#将这些点放在与物体的参考系相同的位置</gydF4y2Baspan><span class="c1"># object_points.setParent (object.Parent ())</gydF4y2Baspan><span class="c1">#设置包含点的对象名称</gydF4y2Baspan><span class="n">object_points</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“AutoPoints n</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">NUM_POINTS</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">path_settings</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddMillingProject</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“AutoPointFollow设置”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">状态</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">path_settings</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setMillingParameters</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">部分</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">object_points</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">在这一点上，我们可能不得不手动调整工具对象或参考框架</gydF4y2Baspan><span class="c1">如果成功则运行create程序</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">调用</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#做</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#-------------------------------------------------------------</gydF4y2Baspan><span class="c1">#选项5:创建一个跟随点项目(类似于选项4)</gydF4y2Baspan><span class="c1">#首先，我们需要从提供的点创建一个对象，或者将点添加到一个现有的对象，并可选地将它们投射到表面上</gydF4y2Baspan><span class="c1">#创建一个新对象，给定的点列表:</gydF4y2Baspan><span class="n">object_curve</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddCurve</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">或者，我们可以在物体表面投影点</gydF4y2Baspan><span class="c1">#对象= RDK。项（＇Object', ITEM_TYPE_OBJECT)</span><span class="c1"># object_curve = object。AddCurve（点，PROJECTION_ALONG_NORMAL_RECALC）</gydF4y2Baspan><span class="c1">#将曲线放置在与物体的参考系相同的位置</gydF4y2Baspan><span class="c1"># object_curve.setParent (object.Parent ())</gydF4y2Baspan><span class="c1">#设置包含点的对象名称</gydF4y2Baspan><span class="n">object_curve</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“AutoPoints n</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">NUM_POINTS</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">创建一个新的“曲线跟踪项目”来自动跟踪曲线</gydF4y2Baspan><span class="n">path_settings</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddMillingProject</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“AutoCurveFollow设置”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">状态</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">path_settings</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setMillingParameters</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">部分</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">object_curve</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">在这一点上，我们可能不得不手动调整工具对象或参考框架</gydF4y2Baspan><span class="c1">如果成功则运行create程序</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">调用</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#做</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#-------------------------------------------------------------</gydF4y2Baspan><span class="c1">#选项6:使用Python脚本移动机器人并使用外部测量系统进行测量</gydF4y2Baspan><span class="c1">#这个例子是为了通过距离测量和使用激光跟踪仪或立体摄像机来帮助验证机器人的准确性</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ConnectSafe</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">＜=</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“无法连接到机器人”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setRunMode</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">RUNMODE_RUN_ROBOT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">如果连接成功是多余的</gydF4y2Baspan><span class="n">POINTS_NOMINAL</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［］</gydF4y2Baspan><span class="n">POINTS_ACCURATE</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［］</gydF4y2Baspan><span class="n">STABILIZATION_TIME</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="c1">#测量前的稳定时间(秒)</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">NUM_POINTS</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="c1">使用参考方向和XYZ坐标构建一个目标</gydF4y2Baspan><span class="n">pose_i</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">pose_ref</gydF4y2Baspan><span class="n">pose_i</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPos</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="c1">使用法向运动学移动到目标</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">RunMessage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">言归正传</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">(名义运动学)'</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">RunMessage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">str</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">Pose_2_KUKA</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">pose_i</gydF4y2Baspan><span class="p">）））</gydF4y2Baspan><span class="c1">#求解名义逆运动学</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setAccuracyActive</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">霁</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SolveIK</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">pose_i</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">霁</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">暂停</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">STABILIZATION_TIME</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#测量</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">pose1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">pose2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">npoints1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">npoints2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">时间</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">错误</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">StereoCamera_Measure</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">错误</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">npoints1</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">npoints2</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“无效的测量。两秒钟后再试……”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">暂停</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">其他的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">计算工具相对于参考系的姿态</gydF4y2Baspan><span class="n">测量</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">invH</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">pose1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">pose2</gydF4y2Baspan><span class="c1">#检索测量值的XYZ值</gydF4y2Baspan><span class="n">POINTS_NOMINAL</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">测量</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Pos</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="k">打破</gydF4y2Baspan><span class="c1">#移动到目标与精确的运动学</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">RunMessage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">言归正传</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">(准确的运动学)'</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setAccuracyActive</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">霁</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SolveIK</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">pose_i</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">霁</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">暂停</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">STABILIZATION_TIME</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">pose1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">pose2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">npoints1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">npoints2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">时间</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">错误</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">StereoCamera_Measure</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">错误</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">npoints1</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">npoints2</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“无效的测量。两秒钟后再试……”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">暂停</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">其他的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">计算工具相对于参考系的姿态</gydF4y2Baspan><span class="n">测量</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">invH</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">pose1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">pose2</gydF4y2Baspan><span class="c1">#检索测量值的XYZ值</gydF4y2Baspan><span class="n">POINTS_ACCURATE</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">测量</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Pos</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="k">打破</gydF4y2Baspan><span class="c1">#在这一点上，我们可以检查精确和标称运动学，并创建以下表格:</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“爸爸</gydF4y2Baspan><span class="se">\ t</gydF4y2Baspan><span class="s1">pb</gydF4y2Baspan><span class="se">\ t</gydF4y2Baspan><span class="s1">经销</gydF4y2Baspan><span class="se">\ t</gydF4y2Baspan><span class="s1">dist笔名</gydF4y2Baspan><span class="se">\ t</gydF4y2Baspan><span class="s1">dist acc</gydF4y2Baspan><span class="se">\ t</gydF4y2Baspan><span class="s1">以前的错误</gydF4y2Baspan><span class="se">\ t</gydF4y2Baspan><span class="s1">acc的错误</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">numPoints</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">j</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">numPoints</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">numPoints</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">dist_program</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">距离</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">j</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="n">dist_nominal</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">距离</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">POINTS_NOMINAL</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">POINTS_NOMINAL</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">j</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="n">dist_accurate</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">距离</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">POINTS_ACCURATE</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">POINTS_ACCURATE</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">j</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="n">error_nominal</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">腹肌</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">dist_nominal</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">dist_program</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">error_accurate</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">腹肌</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">dist_accurate</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">dist_program</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="se">\ t</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="se">\ t</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="se">\ t</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="se">\ t</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="se">\ t</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="se">\ t</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">j</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">dist_program</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">dist_nominal</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">dist_accurate</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">error_nominal</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">error_accurate</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="points-to-curve"> <h2><span class="section-number">6.5.</gydF4y2Baspan>曲线点<一个class="headerlink" href="#points-to-curve" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子展示了如何从API自动设置一个曲线跟踪项目。本例通过设置曲线跟踪项目或点跟踪项目，以不同的方式实现了与前面示例相同的目标。</p><gydF4y2Badiv class="literal-block-wrapper docutils container" id="curve-follow-project"> <div class="code-block-caption"> <span class="caption-text">曲线跟踪项目</gydF4y2Baspan> <a class="headerlink" href="#curve-follow-project" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">输入help("robolink")或help("robodk")查看更多信息</gydF4y2Baspan><span class="c1">#按F5运行脚本</gydF4y2Baspan><span class="c1">#文档://m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">#参考://m.sinclairbody.com/doc/en/PythonAPI/index.html</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">#在给定起点和终点的直线上按步移动机器人</gydF4y2Baspan><span class="c1">#这个宏展示了使用Python脚本和RoboDK API编程机器人的不同方式</gydF4y2Baspan><span class="c1">#默认参数:</gydF4y2Baspan><span class="n">P_START</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1755</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">500</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">2155</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1">#相对于机器人基础框架的起始点</gydF4y2Baspan><span class="n">P_END</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1755</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">600</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">2155</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1">端点相对于机器人基础框架</gydF4y2Baspan><span class="n">NUM_POINTS</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">10</gydF4y2Baspan><span class="c1">要插值的点的数量</gydF4y2Baspan><span class="c1">#函数定义创建一个点列表(行)</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">MakePoints</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">xStart</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">xEnd</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">numPoints</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""生成点列表""" "</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">xStart</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">xEnd</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">"起点和终点必须是三维向量"</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">numPoints</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“至少需要两点”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#起点</gydF4y2Baspan><span class="n">pt_list</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［］</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">xStart</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">y</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">xStart</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">z</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">xStart</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1">我们在每个插值点之间加/减多少</gydF4y2Baspan><span class="n">x_steps</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">xEnd</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">xStart</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">numPoints</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">y_steps</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">xEnd</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">xStart</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">numPoints</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">z_steps</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">xEnd</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">xStart</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">numPoints</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#逐步添加到每个点，直到到达终点</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">numPoints</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">point_i</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">y</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">z</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1">#创建一个点</gydF4y2Baspan><span class="c1">#添加点到列表中</gydF4y2Baspan><span class="n">pt_list</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">point_i</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">x_steps</gydF4y2Baspan><span class="n">y</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">y</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">y_steps</gydF4y2Baspan><span class="n">z</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">z</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">z_steps</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="n">pt_list</gydF4y2Baspan><span class="c1">#---------------------------------------------------</gydF4y2Baspan><span class="c1">#--------------- 程序开始 ---------------------</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># API与RoboDK通信，用于模拟和离线/在线编程</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robomath</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">#工业机器人工具箱世界杯2022美洲预选赛直播</gydF4y2Baspan><span class="c1">#生成点曲线路径</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">MakePoints</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">P_START</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">P_END</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">NUM_POINTS</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#初始化RoboDK API</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#关闭自动渲染(更快)</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">渲染</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#自动删除之前生成的项目(自动标记)</gydF4y2Baspan><span class="n">list_items</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemList</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">列出所有名字</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">list_items</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">startswith</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“汽车”</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">删除</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#提示用户选择一个机器人(如果只有一个机器人可用，它将自动选择该机器人)</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemUserPick</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“选择一个机器人”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_ROBOT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#在开始模拟之前打开渲染</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">渲染</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">如果用户点击取消，#终止</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#检索机器人参考系</gydF4y2Baspan><span class="n">参考</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">父</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#使用机器人基本框架作为活动参考</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参考</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#获取机器人的当前方向(相对于活动参考系和工具架)</gydF4y2Baspan><span class="n">pose_ref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">Pose_2_TxyzRxyz</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">pose_ref</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="c1"># a pose也可以定义为xyzwpr / xyzABC</gydF4y2Baspan><span class="c1">#pose_ref = TxyzRxyz_2_Pose([100,200,300,0,0,pi])</gydF4y2Baspan><span class="c1">#-------------------------------------------------------------</gydF4y2Baspan><span class="c1">#选项1:创建一个曲线跟随项目</gydF4y2Baspan><span class="c1">#首先，我们需要从提供的点创建一个对象，或者将点添加到一个现有的对象，并可选地将它们投射到表面上</gydF4y2Baspan><span class="c1">#创建一个新对象，给定点的列表(3xN的向量可以扩展到6xN，以提供法线)</gydF4y2Baspan><span class="n">object_points</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddPoints</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">或者，我们可以在物体表面投影点</gydF4y2Baspan><span class="c1">#对象= RDK。项（＇Object', ITEM_TYPE_OBJECT)</span><span class="c1"># object_points =对象。AddPoints（点，PROJECTION_ALONG_NORMAL_RECALC）</gydF4y2Baspan><span class="c1">#将这些点放在与物体的参考系相同的位置</gydF4y2Baspan><span class="c1"># object_points.setParent (object.Parent ())</gydF4y2Baspan><span class="c1">#设置包含点的对象名称</gydF4y2Baspan><span class="n">object_points</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“AutoPoints n</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">NUM_POINTS</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">path_settings</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddMillingProject</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“AutoPointFollow设置”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">状态</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">path_settings</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setMillingParameters</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">部分</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">object_points</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">在这一点上，我们可能不得不手动调整工具对象或参考框架</gydF4y2Baspan><span class="c1">如果成功则运行create程序</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">调用</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#做</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#-------------------------------------------------------------</gydF4y2Baspan><span class="c1">#选项2:创建一个点跟踪项目(类似于选项4)</gydF4y2Baspan><span class="c1">#首先，我们需要从提供的点创建一个对象，或者将点添加到一个现有的对象，并可选地将它们投射到表面上</gydF4y2Baspan><span class="c1">#创建一个新对象，给定的点列表:</gydF4y2Baspan><span class="n">object_curve</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddCurve</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">或者，我们可以在物体表面投影点</gydF4y2Baspan><span class="c1">#对象= RDK。项（＇Object', ITEM_TYPE_OBJECT)</span><span class="c1"># object_curve = object。AddCurve（点，PROJECTION_ALONG_NORMAL_RECALC）</gydF4y2Baspan><span class="c1">#将曲线放置在与物体的参考系相同的位置</gydF4y2Baspan><span class="c1"># object_curve.setParent (object.Parent ())</gydF4y2Baspan><span class="c1">#设置包含点的对象名称</gydF4y2Baspan><span class="n">object_curve</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“AutoPoints n</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">NUM_POINTS</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">创建一个新的“曲线跟踪项目”来自动跟踪曲线</gydF4y2Baspan><span class="n">path_settings</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddMillingProject</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“AutoCurveFollow设置”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">状态</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">path_settings</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setMillingParameters</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">部分</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">object_curve</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">在这一点上，我们可能不得不手动调整工具对象或参考框架</gydF4y2Baspan><span class="c1">如果成功则运行create程序</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">调用</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#做</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="csv-file-to-program-xyz"> <h2><span class="section-number">6.6.</gydF4y2Baspan>CSV文件到程序(XYZ)<一个class="headerlink" href="#csv-file-to-program-xyz" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子展示了如何从给定XYZ坐标列表的CSV文件中导入目标。可选地，第四列将更新程序中的速度。</p><p>gydF4y2Ba默认情况下，这个例子可以作为RoboDK脚本使用:</p><b锁问uote> <div> <ol class="arabic simple"> <li><p>选择工具-运行脚本</p></gydF4y2Bali> <li><p>选择<gydF4y2Baem>ImportCSV_XYZ</gydF4y2Baem></p></li> <li><p>选择CSV文件(例如:C:/RoboDK/Library/Scripts/SampleXYZS.csv)</p></gydF4y2Bali> </ol> </div> </blockquote> <dl class="simple"> <dt> 注:</gydF4y2Badt> <dd> <ul class="simple"> <li><p>在创建目标时，机器人的工具方向被用作参考。</p></gydF4y2Bali> <li><p>XYZ值必须以毫米为单位提供，速度必须以毫米/秒提供。</p></gydF4y2Bali> <li><p>活动工具和参考系将在程序中使用。</p></gydF4y2Bali> <li><p>该程序将隐藏指令，您可以右键单击一个程序并选择“显示指令”显示指令。</p></gydF4y2Bali> <li><p>您可以选择一个或移动移动指令，并选择“选择目标”查看目标。</p></gydF4y2Bali> </ul> </dd> </dl> <img alt="_images / Import-CSV-Robot-Simulation.png＂src="//m.sinclairbody.com/doc/en/PythonAPI/_images/Import-CSV-Robot-Simulation.png"> <div class="literal-block-wrapper docutils container" id="convert-a-csv-file-to-a-program-xyz"> <div class="code-block-caption"> <span class="caption-text">将CSV文件转换为程序(XYZ)</gydF4y2Baspan> <a class="headerlink" href="#convert-a-csv-file-to-a-program-xyz" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">这个宏显示了如何加载XYZ点的列表，包括速度</gydF4y2Baspan><span class="c1">#列表必须提供为X,Y,Z，速度。单位必须为mm和mm/s</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robodialogs</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robofileio</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">#----------------------------</gydF4y2Baspan><span class="c1">#全局变量:</gydF4y2Baspan><span class="c1"># LOAD_AS_PROGRAM标志:</gydF4y2Baspan><span class="c1">#设置为True在UI中生成程序:我们可以手动修改目标并正确地看到程序</gydF4y2Baspan><span class="c1">#设置为False，它将在运行宏时直接模拟或生成机器人程序</gydF4y2Baspan><span class="n">LOAD_AS_PROGRAM</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="c1">#设置参考框架的名称来放置目标:</gydF4y2Baspan><span class="n">REFERENCE_NAME</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“参考CSV”</gydF4y2Baspan><span class="c1">#设置引用目标的名称</gydF4y2Baspan><span class="c1">#(方向将相对于此目标保持不变)</gydF4y2Baspan><span class="n">TARGET_NAME</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“回家”</gydF4y2Baspan><span class="c1">#---------------------------</gydF4y2Baspan><span class="c1">#启动RoboDK API</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#让用户选择一个文件:</gydF4y2Baspan><span class="n">rdk_file_path</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“PATH_OPENSTATION”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">path_file</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">getOpenFile</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">rdk_file_path</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s2">“/”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">path_file</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“没有选择”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">从文件路径中获取程序名</gydF4y2Baspan><span class="n">program_name</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">getFileName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">path_file</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#加载CSV文件为列表[[x,y,z,speed]，[x,y,z,speed]，…]</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">LoadList</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">path_file</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#删除之前生成的遵循特定命名的程序</gydF4y2Baspan><span class="c1">#list_names = RDK.ItemList(False)</gydF4y2Baspan><span class="c1"># list_names中的item_name:</gydF4y2Baspan><span class="c1"># if item_name.startswith('Auto'):</gydF4y2Baspan><span class="c1"># RDK.Item (item_name) delete ()</gydF4y2Baspan><span class="c1">#选择机器人(只有当有2个或更多机器人时才会弹出)</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemUserPick</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“选择一个机器人”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_ROBOT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“机器人未被选中或无效”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">获取参考框架以生成路径</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">REFERENCE_NAME</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_FRAME</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“没有找到参考系。使用名称:</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">REFERENCE_NAME</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">使用主目标作为参考</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">TARGET_NAME</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_TARGET</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“主场目标是无效的。设置一个名为:</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">TARGET_NAME</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#设置机器人到home位置</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setJoints</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="c1">#从主目标获取姿态引用</gydF4y2Baspan><span class="n">pose_ref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">LOAD_AS_PROGRAM</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#添加一个新程序</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddProgram</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">program_name</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#关闭渲染(更快)</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">渲染</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#不显示指令加快速度:</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ShowInstructions</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#记住速度，这样我们就不会在每条指令中都设置速度</gydF4y2Baspan><span class="n">current_speed</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="c1">#非常重要:确保我们设置了参考框架和工具框架，这样机器人就能意识到它</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseTool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">PoseTool</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="c1">遍历所有点</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="p">)):</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">pose_ref</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPos</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="c1">如果有第4列，则更新速度</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="o">> =</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">速度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1">如果速度与之前设置的速度不同，则更新程序</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">类型</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">速度</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="nb">str</gydF4y2Baspan><span class="ow">而且</gydF4y2Baspan><span class="n">速度</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="n">current_speed</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setSpeed</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">速度</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">current_speed</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">速度</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddTarget</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">不</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="c1">#添加一个线性运动(除了第一个点是关节运动)</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">其他的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#不时更新以通知用户进度</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ShowTargets</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ShowMessage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“加载</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s2">：</gydF4y2Baspan><span class="si">% .1f</gydF4y2Baspan><span class="s2"></span><span class="si">% %</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">program_name</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="p">）），</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">渲染</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ShowTargets</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">其他的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#非常重要:确保我们设置了参考框架和工具框架，这样机器人就能意识到它</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseTool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">PoseTool</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="c1">#记住速度，这样我们就不会在每条指令中都设置速度</gydF4y2Baspan><span class="n">current_speed</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="c1">遍历所有点</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="p">)):</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">pose_ref</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPos</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="c1">如果有第4列，则更新速度</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="o">> =</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">速度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1">如果速度与之前设置的速度不同，则更新程序</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">类型</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">速度</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="nb">str</gydF4y2Baspan><span class="ow">而且</gydF4y2Baspan><span class="n">速度</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="n">current_speed</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setSpeed</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">速度</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">current_speed</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">速度</gydF4y2Baspan><span class="c1">#添加一个线性运动(除了第一个点是关节运动)</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">其他的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#不时更新以通知用户进度</gydF4y2Baspan><span class="c1">#如果我% 200 == 0:</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ShowMessage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">”计划</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s2">：</gydF4y2Baspan><span class="si">% .1f</gydF4y2Baspan><span class="s2"></span><span class="si">% %</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">program_name</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="p">）），</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ShowMessage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“完成”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“完成”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="csv-file-to-program-xyzwpr"> <h2><span class="section-number">6.7.</gydF4y2Baspan>CSV文件到程序(XYZWPR)<一个class="headerlink" href="#csv-file-to-program-xyzwpr" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子展示了如何从给定XYZWPR坐标(姿态)列表的CSV文件中导入目标。</p><gydF4y2Badl class="simple"> <dt> 默认情况下，这个例子可以作为RoboDK脚本使用:</gydF4y2Badt> <dd> <ol class="arabic simple"> <li><p>选择工具-运行脚本</p></gydF4y2Bali> <li><p>选择<gydF4y2Baem>ImportCSV_XYZWPR</gydF4y2Baem></p></li> <li><p>选择CSV文件(例如:C:/RoboDK/Library/Scripts/ImportCSV_XYZWPR.csv)</p></gydF4y2Bali> </ol> </dd> <dt> 注:</gydF4y2Badt> <dd> <ul class="simple"> <li><p>本例中使用目标方向的欧拉格式Z->Y ' ->X "(可以使用rotx, roty和rotz函数轻松更改)</p></gydF4y2Bali> <li><p>XYZ值必须以毫米为单位，Rx, Ry, Rz值必须以度为单位。</p></gydF4y2Bali> <li><p>活动工具和参考系将在程序中使用。</p></gydF4y2Bali> <li><p>该程序将隐藏指令，您可以右键单击一个程序并选择显示指令以显示指令。</p></gydF4y2Bali> <li><p>您可以选择一个或移动移动指令，并选择“选择目标”查看目标。</p></gydF4y2Bali> </ul> </dd> </dl> <img alt="_images / Import-CSV-Robot-Simulation-XYZWPR.png＂src="//m.sinclairbody.com/doc/en/PythonAPI/_images/Import-CSV-Robot-Simulation-XYZWPR.png"> <div class="literal-block-wrapper docutils container" id="convert-a-csv-file-to-a-program-xyzwpr"> <div class="code-block-caption"> <span class="caption-text">将CSV文件转换为程序(XYZWPR)</gydF4y2Baspan> <a class="headerlink" href="#convert-a-csv-file-to-a-program-xyzwpr" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">#这个宏可以从RoboDK的Denso程序中加载CSV文件。</gydF4y2Baspan><span class="c1">#支持的文件类型为:</gydF4y2Baspan><span class="c1"># 1-工具数据:Tool.csv</gydF4y2Baspan><span class="c1"># 2-工作对象数据:Work.csv</gydF4y2Baspan><span class="c1"># 3-目标数据:P_Var.csv</gydF4y2Baspan><span class="c1">#这个宏也可以过滤一个给定的目标文件</gydF4y2Baspan><span class="c1">#输入help("robodk.robolink")或help("robodk.robomath")获取更多信息</gydF4y2Baspan><span class="c1">#按F5运行脚本</gydF4y2Baspan><span class="c1">#访问://m.sinclairbody.com/doc/PythonAPI/</gydF4y2Baspan><span class="c1">#用于RoboDK API文档</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># API与RoboDK通信</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robomath</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">#机器人工具箱</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robodialogs</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robofileio</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">#开始与RoboDK沟通</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#要求用户选择机器人(忽略弹出窗口，如果只有</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemUserPick</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“选择一个机器人”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_ROBOT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#检查用户是否选择了机器人</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#自动检索活动引用和工具</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getLink</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">ITEM_TYPE_FRAME</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">工具</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getLink</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">ITEM_TYPE_TOOL</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1"># frame = rdk。ItemUserPick（＇选择一个参考框架＇，ITEM_TYPE_FRAME）</gydF4y2Baspan><span class="c1">#工具= rdk。ItemUserPick（＇选择一个工具＇，ITEM_TYPE_TOOL）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">工具</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“选择适当的框架和工具引用”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#函数转换XYZWPR为一个姿势</gydF4y2Baspan><span class="c1">#重要!指定旋转的顺序</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">xyzwpr_to_pose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">xyzwpr</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">y</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">z</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">处方</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">变化中</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">rz</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">xyzwpr</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">y</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">z</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">rotz</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">rz</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">180</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">roty</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">变化中</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">180</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">rotx</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">处方</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">180</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#返回transl (x, y, z) * rotx (rx *π/ 180)* roty (ry *π/ 180)* rotz (rz *π/ 180)</gydF4y2Baspan><span class="c1">#返回KUKA_2_Pose (xyzwpr)</gydF4y2Baspan><span class="c1"># csv = 'C:/Users/Albert/Desktop/Var_P.csv'</gydF4y2Baspan><span class="n">csv_file</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">getOpenFile</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“PATH_OPENSTATION”</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="c1">#指定文件编解码器</gydF4y2Baspan><span class="n">编解码器</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“utf - 8”</gydF4y2Baspan><span class="c1">#“iso - 8859 - 1”</gydF4y2Baspan><span class="c1">#加载P_Var.CSV数据作为姿态列表，包括参考和工具框架的链接</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">load_targets</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">strfile</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">csvdata</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">LoadList</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">strfile</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">”、“</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">编解码器</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">提出了</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［］</gydF4y2Baspan><span class="n">idx</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［］</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">csvdata</gydF4y2Baspan><span class="p">)):</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">y</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">z</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">处方</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">变化中</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">rz</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">csvdata</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">6</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">提出了</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">xyzwpr_to_pose</gydF4y2Baspan><span class="p">([</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">y</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">z</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">处方</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">变化中</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">rz</gydF4y2Baspan><span class="p">)))</gydF4y2Baspan><span class="c1"># idxs.append (csvdata[我][6])</gydF4y2Baspan><span class="n">idx</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="n">提出了</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">idx</gydF4y2Baspan><span class="c1">#在RoboDK中加载并显示P_Var.CSV中的目标</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">load_targets_GUI</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">strfile</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">提出了</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">idx</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">load_targets</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">strfile</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">program_name</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">getFileName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">strfile</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">program_name</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">program_name</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">取代</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“- - -”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“_”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">取代</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">' '</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“_”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">program_name</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_PROGRAM</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">删除</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddProgram</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">program_name</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setTool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">工具</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">JointsHome</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">idx</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">邮政编码</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">提出了</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">idx</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s1">-</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">program_name</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">idx</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_TARGET</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">删除</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddTarget</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">试一试</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">除了</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“警告:</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s1">无法联系到您。它不会被添加到程序中。</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">load_targets_move</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">strfile</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">提出了</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">idx</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">load_targets</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">strfile</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setTool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">工具</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">JointsHome</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">idx</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">邮政编码</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">提出了</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">idx</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="k">试一试</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">除了</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ShowMessage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">的目标</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">无法联系上'</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">idx</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">双击后强行移动机器人</gydF4y2Baspan><span class="c1"># load_targets_move (csv_file)</gydF4y2Baspan><span class="c1">#辞职()</gydF4y2Baspan><span class="c1">#推荐的操作模式:</gydF4y2Baspan><span class="c1">双击python文件在RoboDK站创建一个程序</gydF4y2Baspan><span class="c1"># 2-Generate program直接生成程序</gydF4y2Baspan><span class="n">MAKE_GUI_PROGRAM</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setTool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">工具</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">RunMode</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="n">RUNMODE_SIMULATE</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">MAKE_GUI_PROGRAM</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="c1"># MAKE_GUI_PROGRAM = mbox('你想创建一个新程序吗?如果没有，机器人将沿着tagets移动'，'是'，'否')</gydF4y2Baspan><span class="k">其他的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">如果我们在程序生成模式下运行，只需移动机器人</gydF4y2Baspan><span class="n">MAKE_GUI_PROGRAM</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">MAKE_GUI_PROGRAM</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">渲染</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#关闭渲染会更快</gydF4y2Baspan><span class="n">load_targets_GUI</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">csv_file</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">其他的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">load_targets_move</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">csv_file</gydF4y2Baspan><span class="p">）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="load-a-kuka-src-file"> <h2><span class="section-number">6.8.</gydF4y2Baspan>加载一个KUKA SRC文件<一个class="headerlink" href="#load-a-kuka-src-file" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子展示了如何将KUKA SRC文件作为机器人程序导入。确保首先在RoboDK中加载你的KUKA机器人(用于SRC程序的机器人)，然后使用Tools -> run - script运行这个脚本。</p><gydF4y2Badiv class="literal-block-wrapper docutils container" id="load-kuka-src-program"> <div class="code-block-caption"> <span class="caption-text">加载库卡SRC程序</gydF4y2Baspan> <a class="headerlink" href="#load-kuka-src-program" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">这个宏展示了如何加载一个KUKA SRC文件</gydF4y2Baspan><span class="c1">带关节坐标的# PTP运动和带笛卡尔信息的LIN运动(XYZABC)将作为程序导入。</gydF4y2Baspan><span class="c1">#这个宏还支持定义工具和基本内联，并使用VEL.CP全局变量改变速度</gydF4y2Baspan><span class="c1">示例程序:</gydF4y2Baspan><span class="c1"># DEF铣()</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1"># $ base ={帧:x 0.000, y -1000.000, z 0.000, a 0.000, b 0.000, c 0.000}</gydF4y2Baspan><span class="c1"># $ tool ={帧:x - 466.604, y -4.165, z 109.636, a -0.000, b 90.000, c 0.000}</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1"># $韦尔。Cp = 1.00000</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1"># PTP {a1 107.78457, a2 -44.95260, a3 141.64681, a4 107.66839, a5 -87.93467, a6 6.37710}</gydF4y2Baspan><span class="c1"># Lin {x -0.000, y -0.000, z 6.350, a -180.000, b 0.000, c -180.000}</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1"># $韦尔。Cp = 0.02117</gydF4y2Baspan><span class="c1"># Lin {x 276.225, y 0.000, z 6.350, a 180.000, b 0.000, c -180.000}</gydF4y2Baspan><span class="c1"># Lin {x 276.225, y 323.850, z 6.350, a -160.000, b 0.000, c 180.000}</gydF4y2Baspan><span class="c1"># Lin {x -0.000, y 323.850, z 6.350, a -180.000, b -0.000, c -180.000}</gydF4y2Baspan><span class="c1"># Lin {x -0.000, y -0.000, z 6.350, a -180.000, b 0.000, c -180.000}</gydF4y2Baspan><span class="c1"># $韦尔。Cp = 1.00000</gydF4y2Baspan><span class="c1"># Lin {x -0.000, y -0.000, z 106.350, a -180.000, b 0.000, c -180.000}</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">#结束</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robomath</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">#机器人工具箱</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robodialogs</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robofileio</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">#---------------------------</gydF4y2Baspan><span class="c1">#启动RoboDK API</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#让用户选择一个SRC文件:</gydF4y2Baspan><span class="n">rdk_file_path</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“PATH_OPENSTATION”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">src_file_path</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">getOpenFile</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">rdk_file_path</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s2">“/”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">src_file_path</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“没有选择”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">从文件路径中获取程序名</gydF4y2Baspan><span class="n">program_name</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">getFileName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">src_file_path</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“加载程序:”</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">program_name</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">src_file_path</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">较低的</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">endswith</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“.src”</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">"所选文件无效。选择一个SRC文件。”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">getvalue</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""从一行中获取所有数值"""</gydF4y2Baspan><span class="c1"># Lin {x 1671.189, y -562.497, z -243.070, a 173.363, b -8.525, c -113.306} c_dis</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">取代</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">"，"</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">”“</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">取代</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“}”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">”“</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">值</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">分裂</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">”“</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">list_value</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［］</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">值</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">试一试</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">浮动</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">除了</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">继续</gydF4y2Baspan><span class="n">list_value</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="n">list_value</gydF4y2Baspan><span class="c1">#让用户选择一个机器人(如果有多个机器人可用)</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemUserPick</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“选择一个机器人”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_ROBOT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“机器人未被选中或无效”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#获取活动参考系</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getLink</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">ITEM_TYPE_FRAME</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="c1">#如果没有活动参考系，使用机器人底座</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">父</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#获取活动工具框架</gydF4y2Baspan><span class="n">工具</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getLink</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">ITEM_TYPE_TOOL</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#添加一个新程序</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddProgram</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">program_name</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#关闭渲染(更快)</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">渲染</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#不显示指令加快速度:</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ShowInstructions</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">打开文件，遍历每一行</gydF4y2Baspan><span class="n">f</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">开放</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">src_file_path</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">f</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#删除空字符:</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">带</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“装货线:”</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#按顺序获取所有数值</gydF4y2Baspan><span class="n">值</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">getvalue</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#增加计数器</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">#更新TCP速度(KUKA以m/s为单位，RoboDK以mm/s为单位)</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">startswith</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“韦尔美元。CP”</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setSpeed</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">值</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="mi">1000</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">继续</gydF4y2Baspan><span class="c1">#检查包含姿势的操作</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">值</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="mi">6</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“警告!无效行:"</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">继续</gydF4y2Baspan><span class="c1">#检查我们需要添加什么指令:</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">startswith</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“林”</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddTarget</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">不</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">KUKA_2_Pose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">值</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#检查PTP移动</gydF4y2Baspan><span class="k">elif</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">startswith</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“元”</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddTarget</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">不</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setAsJointTarget</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setJoints</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">值</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#设置工具</gydF4y2Baspan><span class="k">elif</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">startswith</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“美元工具”</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">KUKA_2_Pose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">值</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">工具</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddTool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“SRC工具”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setTool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">工具</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#设置参考系</gydF4y2Baspan><span class="k">elif</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">startswith</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“美元基地”</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“SRC基地”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">父</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">KUKA_2_Pose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">值</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#隐藏目标</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ShowTargets</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#显示说明</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ShowInstructions</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ShowMessage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“完成”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“完成”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="test-move-feasibility"> <h2><span class="section-number">6.9.</gydF4y2Baspan>测试移动可行性<一个class="headerlink" href="#test-move-feasibility" title="¶＂>gydF4y2Ba¶</一个></h2><p>本例创建了一个程序，该程序通过一组点来安全地移动机器人，以检查是否可以实现线性运动(包括是否进行碰撞检查)。这些点被自动创建为围绕参考目标的立方体网格。如果无法实现从一点到下一点的线性运动，机器人将尝试关节运动，如果关节运动也不可能实现，则跳过该点。</p><gydF4y2Badiv class="literal-block-wrapper docutils container" id="test-movel-and-movej"> <div class="code-block-caption"> <span class="caption-text">测试MoveL和MoveJ</gydF4y2Baspan> <a class="headerlink" href="#test-movel-and-movej" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">#这个宏展示了如何创建一个程序来移动机器人通过一组点</gydF4y2Baspan><span class="c1">#点被自动创建为围绕参考目标的立方体网格</gydF4y2Baspan><span class="c1">#如果从一个点到下一个点的线性运动不能完成，机器人将遵循关节运动</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># API与RoboDK通信</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robomath</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">基本矩阵运算</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">随机</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="n">统一的</gydF4y2Baspan><span class="c1">#随机计算rz(绕Z轴旋转)</gydF4y2Baspan><span class="c1">#引用目标的名称</gydF4y2Baspan><span class="n">REFERENCE_TARGET</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“RefTarget”</gydF4y2Baspan><span class="c1">#检查碰撞</gydF4y2Baspan><span class="n">CHECK_COLLISIONS</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="c1">#启动RoboDK API</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#设置碰撞检查开启或关闭</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setCollisionActive</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">COLLISION_ON</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">CHECK_COLLISIONS</gydF4y2Baspan><span class="k">其他的</gydF4y2Baspan><span class="n">COLLISION_OFF</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#在机器人上运行:强制程序在连接的机器人上运行(行为与右键单击程序，然后选择“在机器人上运行”相同)</gydF4y2Baspan><span class="c1"># RDK.setRunMode (RUNMODE_RUN_ROBOT)</gydF4y2Baspan><span class="c1">让主/唯一的机器人进入空间站</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_ROBOT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“机器人无效或不可用”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#获取活动参考系</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getLink</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">ITEM_TYPE_FRAME</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">父</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#获得关于机器人的参考姿势</gydF4y2Baspan><span class="n">frame_pose</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">PoseFrame</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#获取活动工具</gydF4y2Baspan><span class="n">工具</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getLink</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">ITEM_TYPE_TOOL</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">工具</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">工具</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddTool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">75</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="s2">“工具电网”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseTool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">工具</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#获取目标引用RefTarget</gydF4y2Baspan><span class="n">target_ref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">REFERENCE_TARGET</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_TARGET</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">target_ref</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">target_ref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddTarget</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">REFERENCE_TARGET</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#获取参考位置(pose=目标相对于参考系的4x4矩阵)</gydF4y2Baspan><span class="n">pose_ref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">target_ref</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">曾经繁荣</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">target_ref</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">config_ref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">JointsConfig</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">曾经繁荣</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#检索工具姿态</gydF4y2Baspan><span class="n">tool_pose</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">工具</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">PoseTool</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#获取自由度或轴(对于6轴机器人num_dfs = 6)</gydF4y2Baspan><span class="n">num_dofs</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">JointsHome</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">列表</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="c1">#获取目标参考的参考系</gydF4y2Baspan><span class="n">ref_frame</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">target_ref</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">父</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">检查2个机器人配置是否相同的函数定义</gydF4y2Baspan><span class="c1">#配置设置为[后/前，下臂/上臂，翻转/非翻转]位(int值)</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">config_equal</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">config1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">config2</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">config1</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="n">config2</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">config1</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="n">config2</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">config1</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="n">config2</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">]:</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="c1">#创建新程序</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddProgram</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“autocreate”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#这会使程序生成稍微快一些</gydF4y2Baspan><span class="c1"># prog.ShowInstructions(假)</gydF4y2Baspan><span class="c1">#开始创建程序或移动机器人:</gydF4y2Baspan><span class="n">program_or_robot</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="n">program_or_robot</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseTool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">tool_pose</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">program_or_robot</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">target_ref</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">lastjoints</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">曾经繁荣</gydF4y2Baspan><span class="n">rz</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="n">ntargets</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">tz</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">101</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">泰</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">401</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">200</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">tx</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">5001</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">250</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">ntargets</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">ntargets</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">#计算一个随机旋转工具的Z轴</gydF4y2Baspan><span class="c1">#rz =均匀(-20*pi/180, 20*pi/180)</gydF4y2Baspan><span class="c1">#计算新目标的位置:相对于机器人底座平移，并围绕工具旋转</gydF4y2Baspan><span class="n">newtarget_pose</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">tx</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">泰</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">tz</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">pose_ref</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">rotz</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">rz</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#首先，确保目标是可达的:</gydF4y2Baspan><span class="n">newtarget_joints</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SolveIK</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">newtarget_pose</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">lastjoints</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">tool_pose</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">frame_pose</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">newtarget_joints</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">列表</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="n">num_dofs</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“…t一个r得到不再保险一个ch一个ble!! Skipping target'</span><span class="p">）</gydF4y2Baspan><span class="k">继续</gydF4y2Baspan><span class="c1">#创建一个新目标:</gydF4y2Baspan><span class="n">newtarget_name</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">'汽车T</gydF4y2Baspan><span class="si">% .0f</gydF4y2Baspan><span class="s1">，</gydF4y2Baspan><span class="si">% .0f</gydF4y2Baspan><span class="s1">，</gydF4y2Baspan><span class="si">% .0f</gydF4y2Baspan><span class="s1">Rz =</gydF4y2Baspan><span class="si">% .1f</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">tx</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">泰</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">tz</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">rz</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“创建目标</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">：</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">ntargets</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">newtarget_name</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">newtarget</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddTarget</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">newtarget_name</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ref_frame</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#此时，目标是可达的。</gydF4y2Baspan><span class="c1">#我们必须检查我们是否可以做线性移动。我们有两种方法:</gydF4y2Baspan><span class="n">can_move_linear</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="c1"># ------------------------------</gydF4y2Baspan><span class="c1">#验证方法一:检查目的靶关节</gydF4y2Baspan><span class="c1">#并确保我们有相同的配置</gydF4y2Baspan><span class="c1">#一种快速验证的方法(如果机器人关节可以移动超过1圈，这可能并不完美)</gydF4y2Baspan><span class="c1">为了改进这种方法，我们必须检查所有可能的解决方案的配置</gydF4y2Baspan><span class="c1">#从逆运动学，使用SolveIK_All()</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">target_joints_config</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">JointsConfig</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">newtarget_joints</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">config_equal</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">config_ref</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">target_joints_config</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="c1">我们不能做线性移动</gydF4y2Baspan><span class="n">can_move_linear</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“警告!配置与参考目标不相同!线性移动是不可能的”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#将参考配置更新为新的配置</gydF4y2Baspan><span class="n">config_ref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">target_joints_config</gydF4y2Baspan><span class="c1"># -------------------------------</gydF4y2Baspan><span class="c1"># -------------------------------</gydF4y2Baspan><span class="c1">#验证方法二:使用机器人。MoveL_Testoption to check if the robot can make a linear movement</span><span class="c1">#这种方法更可靠，应该能提供100%准确的结果，但可能需要更多时间</gydF4y2Baspan><span class="c1">#机器人。MoveL＿Test can also take collisions into account if collision checking is activated</span><span class="n">问题</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL_Test</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">lastjoints</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">newtarget_pose</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">can_move_linear</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">问题</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">我们可以通过检索机器人关节来检索最终的关节位置</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">can_move_linear</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">newtarget_joints</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1"># ---------------------------------</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">can_move_linear</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">很好，我们不需要修改目标。</gydF4y2Baspan><span class="c1">#然而，我们可以在目标中设置关节，因为这可以让我们在需要时检索机器人配置</gydF4y2Baspan><span class="n">newtarget</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setAsCartesianTarget</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#默认行为</gydF4y2Baspan><span class="n">newtarget</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setJoints</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">newtarget_joints</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">在setjoint之后使用setPose是很重要的，因为它可能会重新计算关节以匹配目标</gydF4y2Baspan><span class="n">newtarget</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">newtarget_pose</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">添加线性移动</gydF4y2Baspan><span class="n">program_or_robot</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">newtarget</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">其他的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#打印(newtarget_joints)</gydF4y2Baspan><span class="c1">#检查我们是否可以做一个关节运动(检查碰撞)</gydF4y2Baspan><span class="n">问题</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ_Test</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">lastjoints</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">newtarget_joints</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">can_move_joints</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">问题</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">can_move_joints</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#跳过这一点</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“跳过动作到:”</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="nb">str</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">newtarget_joints</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="k">继续</gydF4y2Baspan><span class="c1">#确保我们有一个共同的目标和共同的行动</gydF4y2Baspan><span class="n">newtarget</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setAsJointTarget</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#默认行为</gydF4y2Baspan><span class="c1">#为一个联合目标设置姿态并不重要，除非我们想稍后检索姿态</gydF4y2Baspan><span class="c1">#或者我们想使用笛卡尔坐标进行后期处理</gydF4y2Baspan><span class="n">newtarget</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">newtarget_pose</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#确保我们在关节taget的姿态之后设置关节，因为它可能会重新计算姿态</gydF4y2Baspan><span class="n">newtarget</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setJoints</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">newtarget_joints</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#添加关节运动</gydF4y2Baspan><span class="n">program_or_robot</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">newtarget</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">记住最后一个动作的关节位置</gydF4y2Baspan><span class="n">lastjoints</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">newtarget_joints</gydF4y2Baspan><span class="c1">#在结尾显示说明更快:</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ShowInstructions</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">隐藏目标更清晰，更难以意外移动目标</gydF4y2Baspan><span class="c1"># prog.ShowTargets(假)</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">'程序完成</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">目标的</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">ntargets</gydF4y2Baspan><span class="p">）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="docked-ui"> <h2><span class="section-number">6.10.</gydF4y2Baspan>对接界面<一个class="headerlink" href="#docked-ui" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子展示了如何在RoboDK中嵌入一个窗口。在这种情况下，用TKInter创建的GUI窗口被添加为RoboDK中的停靠窗口。</p><gydF4y2Badiv class="literal-block-wrapper docutils container" id="docked-window"> <div class="code-block-caption"> <span class="caption-text">停靠窗口</gydF4y2Baspan> <a class="headerlink" href="#docked-window" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="kn">从</gydF4y2Baspan><span class="nn">tkinter</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">tkinter</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">线程</gydF4y2Baspan><span class="c1">#创建一个新窗口</gydF4y2Baspan><span class="n">窗口</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Tk</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#关闭窗口</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">onClose</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">窗口</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">摧毁</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#触发选择按钮</gydF4y2Baspan><span class="c1">#重要:我们需要在单独的线程上运行操作，因为</gydF4y2Baspan><span class="c1">#(否则，如果我们想与RoboDK窗口交互，它会冻结)</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">on_btnSelect</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">thread_btnSelect</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="c1">#运行按钮动作(例如选择一个项目并显示其名称)</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemUserPick</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“选择一个项目”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ShowMessage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“你选择了这个项目:”</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="n">线程</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">线程</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">thread_btnSelect</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">开始</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#设置窗口标题(必须是唯一的对接工作，尽量有创意)</gydF4y2Baspan><span class="n">window_title</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“RoboDK API停靠窗口”</gydF4y2Baspan><span class="n">窗口</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">标题</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">window_title</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">当我们关闭窗口时删除它</gydF4y2Baspan><span class="n">窗口</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">协议</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“WM_DELETE_WINDOW”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">onClose</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#添加一个按钮(选择动作)</gydF4y2Baspan><span class="n">btnSelect</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">按钮</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">窗口</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">文本</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“触发on_btnSelect”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">高度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">5</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">宽度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">60</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">命令</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">on_btnSelect</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">btnSelect</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">包</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">填满</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">X</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#嵌入窗口</gydF4y2Baspan><span class="n">EmbedWindow</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">window_title</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#运行window事件循环。这就像一个应用程序，将阻塞，直到我们关闭窗口</gydF4y2Baspan><span class="n">窗口</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">mainloop</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="estimated-cycle-time"> <h2><span class="section-number">6.11.</gydF4y2Baspan>预计周期时间<一个class="headerlink" href="#estimated-cycle-time" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子展示了如何计算估计的周期时间。</p><gydF4y2Badl class="simple"> <dt> 更多关于RoboDK如何估计周期时间的信息:</gydF4y2Badt> <dd> <ul class="simple"> <li><p><a class="reference external" href="//m.sinclairbody.com/doc/en/General.html">//m.sinclairbody.com/doc/en/General.html#CycleTime</一个>．</p></gydF4y2Bali> </ul> </dd> </dl> <div class="literal-block-wrapper docutils container" id="cycle-time"> <div class="code-block-caption"> <span class="caption-text">周期时间</gydF4y2Baspan> <a class="headerlink" href="#cycle-time" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">这个例子展示了如何快速计算程序的周期时间</gydF4y2Baspan><span class="c1">作为线性速度和关节速度的函数</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">#准确计算周期时间的重要注意事项和提示:</gydF4y2Baspan><span class="c1">#加工机之细加工约//m.sinclairbody.com/doc/en/General.html</gydF4y2Baspan><span class="c1">#启动RoboDK API</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># RoboDK API</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#让用户选择一个程序</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemUserPick</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">选择一个程序(确保该程序不会改变机器人的速度)</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_PROGRAM</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">检索链接到所选程序的机器人</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getLink</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">ITEM_TYPE_ROBOT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#输出线速度，关节速度和时间(以制表符分隔)</gydF4y2Baspan><span class="n">writeline</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s2">"线速度(mm/s)</gydF4y2Baspan><span class="se">\ t</gydF4y2Baspan><span class="s2">关节速度(deg/s)</gydF4y2Baspan><span class="se">\ t</gydF4y2Baspan><span class="s2">周期时间(s)”</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">writeline</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#准备一个HTML消息，我们可以通过RoboDK API显示给用户:</gydF4y2Baspan><span class="n">msg_html</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s2">“<表边界= 1 > < tr > < td > "</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">writeline</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">取代</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="se">\ t</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">' < / td > < td > '</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s2">" < / td > < / tr >”</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">speed_lin</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">5</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">10</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">20.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">50</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">200</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">500</gydF4y2Baspan><span class="p">]:</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">speed_joints</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">5</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">10</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">20.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">50</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">200</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">500</gydF4y2Baspan><span class="p">]:</gydF4y2Baspan><span class="c1">#设置机器人速度</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setSpeed</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">speed_lin</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">speed_joints</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#更新程序并检索更新的信息:</gydF4y2Baspan><span class="c1"># //m.sinclairbody.com/doc/en/PythonAPI/robodk.html robodk.robolink.Item.Update</gydF4y2Baspan><span class="n">结果</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">程序</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">更新</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">指令</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">时间</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">旅行</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">好吧</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">错误</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">结果</gydF4y2Baspan><span class="c1">#打印信息</gydF4y2Baspan><span class="n">换行符</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="si">% .1f</gydF4y2Baspan><span class="se">\ t</gydF4y2Baspan><span class="si">% .1f</gydF4y2Baspan><span class="se">\ t</gydF4y2Baspan><span class="si">% .1f</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">speed_lin</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">speed_joints</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">时间</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">换行符</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">msg_html</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">msg_html</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s1">' < tr > < td > '</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">换行符</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">取代</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="se">\ t</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">' < / td > < td > '</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s1">' < / td > < / tr > '</gydF4y2Baspan><span class="n">msg_html</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">msg_html</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s1">“> < /表”</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ShowMessage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">msg_html</gydF4y2Baspan><span class="p">）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="change-tool"> <h2><span class="section-number">6.12.</gydF4y2Baspan>改变工具<一个class="headerlink" href="#change-tool" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个宏允许更新给定ID的工具，该ID作为机器人加工目的的参数传递。如果没有传递ID作为参数，它将弹出一条消息。这个宏可以与机器人加工项目一起使用，以改变它模拟的工具。双击您的机器人加工项目，选择Program Events，并输入SetTool(%1)作为换刀事件。</p><gydF4y2Badiv class="literal-block-wrapper docutils container" id="set-milling-tool"> <div class="code-block-caption"> <span class="caption-text">成套铣刀</gydF4y2Baspan> <a class="headerlink" href="#set-milling-tool" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">这个宏允许更新工具，给定一个ID作为参数传递</gydF4y2Baspan><span class="c1">#如果没有传递ID作为参数，它将弹出一条消息</gydF4y2Baspan><span class="c1">#这个宏可以与机器人加工项目一起使用，以改变它模拟的工具</gydF4y2Baspan><span class="c1">双击你的机器人加工项目，选择Program Events，然后输入SetTool(%1)更改工具事件</gydF4y2Baspan><span class="c1"># //m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">sys</gydF4y2Baspan><span class="c1">#允许获取传递的参数参数</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robodialogs</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">TOOL_ID</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">sys</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">argv</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">> =</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">TOOL_ID</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">sys</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">argv</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="k">其他的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">tool_str</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">mbox</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">输入工具编号:</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s2">(例如，对于工具1集合1)”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">条目</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">' 1 '</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">tool_str</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#无输入</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">TOOL_ID</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">tool_str</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#选择机器人</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_ROBOT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“机器人不可用”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#创建工具名称</gydF4y2Baspan><span class="n">tool_name</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“工具”</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="nb">str</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">TOOL_ID</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“使用机器人:”</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“设置工具:”</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">tool_name</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#选择工具</gydF4y2Baspan><span class="n">工具</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">tool_name</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_TOOL</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">工具</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“工具</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s2">根本不存在!”</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">tool_name</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#更新机器人使用工具</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setTool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">工具</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“做!”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="project-curve-to-surface"> <h2><span class="section-number">6.13.</gydF4y2Baspan>投影曲线到曲面<一个class="headerlink" href="#project-curve-to-surface" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子将特征(点/曲线)投影到一个曲面上，并计算曲面的法线。这个例子有两个对象:(1)有曲线和/或点的对象和(2)有一个或多个曲面的对象。</p><gydF4y2Badiv class="literal-block-wrapper docutils container" id="id3"> <div class="code-block-caption"> <span class="caption-text">投影曲线到曲面</gydF4y2Baspan> <a class="headerlink" href="#id3" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">这个例子有两个对象:</gydF4y2Baspan><span class="c1"># 1 -具有特征的对象(曲线和/或点)</gydF4y2Baspan><span class="c1"># 2 -带有表面的对象(其他特征被忽略)</gydF4y2Baspan><span class="c1">这个例子将特征(点/曲线)投影到参考曲面，并计算曲面的法线</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># RoboDK API</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#设置为True反转法线(翻转法线)</gydF4y2Baspan><span class="n">FlipNormals</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="c1">#设置投影类型</gydF4y2Baspan><span class="n">ProjectionType</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">PROJECTION_ALONG_NORMAL_RECALC</gydF4y2Baspan><span class="c1">#可用值包括:</gydF4y2Baspan><span class="c1">#PROJECTION_NONE = 0 #没有曲线投影</gydF4y2Baspan><span class="c1"># projection_nearest = 1 #投影将是表面上最近的点</gydF4y2Baspan><span class="c1">#投影将沿着法线进行。</gydF4y2Baspan><span class="c1">#投影将沿着法线进行。并根据表面法线重新计算法线。</gydF4y2Baspan><span class="c1">#PROJECTION_CLOSEST_RECALC = 4 #投影将是表面上最近的点，法线将重新计算</gydF4y2Baspan><span class="c1">#PROJECTION_RECALC = 5 #法线根据最近投影的表面法线重新计算</gydF4y2Baspan><span class="c1">#-------------------------------------------------------------</gydF4y2Baspan><span class="c1">#要求用户为对象提供特性</gydF4y2Baspan><span class="n">object_features</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemUserPick</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">选择具有投影特征的对象(曲线和/或点)</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_OBJECT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">object_features</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#要求用户提供对象的表面作为参考</gydF4y2Baspan><span class="n">object_surface</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemUserPick</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“选择表面对象以投影特征”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_OBJECT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">object_surface</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#创建一个surface对象的副本</gydF4y2Baspan><span class="n">object_surface</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">复制</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">new_object</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">粘贴</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">object_surface</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">父</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="n">new_object</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“重新计算法线”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">new_object</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setVisible</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#隐藏用于创建所需曲线的新对象的对象</gydF4y2Baspan><span class="n">object_features</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setVisible</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">object_surface</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setVisible</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#关闭渲染(更快)</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">渲染</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">添加所有曲线，按需要投影(遍历所有曲线，直到找不到曲线为止)</gydF4y2Baspan><span class="n">curve_id</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#检索曲线点</gydF4y2Baspan><span class="n">curve_points</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">name_feature</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">object_features</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">GetPoints</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">FEATURE_CURVE</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">curve_id</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">name_feature</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">curve_id</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">curve_id</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="n">npoints</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">curve_points</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">npoints</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">打破</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“添加曲线</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s2">与</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s2">点”</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">name_feature</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">npoints</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">curve_points_proj</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ProjectPoints</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">curve_points</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">object_surface</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ProjectionType</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#可选翻转法线(ijk矢量)</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">FlipNormals</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">ci</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">curve_points_proj</gydF4y2Baspan><span class="p">)):</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">y</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">z</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">j</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">k</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">curve_points_proj</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">ci</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">curve_points_proj</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">ci</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">y</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">z</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">j</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">k</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddCurve</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">curve_points_proj</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">new_object</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">PROJECTION_NONE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">添加所有投影点</gydF4y2Baspan><span class="n">point_list</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">name_feature</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">object_features</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">GetPoints</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">FEATURE_POINT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">npoints</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">point_list</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“添加</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s2">点”</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">npoints</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">npoints</gydF4y2Baspan><span class="o">></gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1"># RDK。AddPoints(point_list, new_object, True, PROJECTION_ALONG_NORMAL_RECALC)</gydF4y2Baspan><span class="n">point_list_proj</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ProjectPoints</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">point_list</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">object_surface</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ProjectionType</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddPoints</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">point_list_proj</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">new_object</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">PROJECTION_NONE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1"># RDK。添加曲线(curve_points, new_object, True, PROJECTION_NONE)</gydF4y2Baspan><span class="c1">#设置曲线宽度</gydF4y2Baspan><span class="n">new_object</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setValue</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“显示”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“LINEW = 2”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#设置曲线颜色</gydF4y2Baspan><span class="n">new_object</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setColorCurve</gydF4y2Baspan><span class="p">([</gydF4y2Baspan><span class="mf">0．0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mf">0．5</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mf">0．5</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="c1">#打开渲染(可选)</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">渲染</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“完成”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="filter-curve-normals"> <h2><span class="section-number">6.14.</gydF4y2Baspan>滤波曲线法线<一个class="headerlink" href="#filter-curve-normals" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个宏显示了如何平均包含曲线的对象的法线。这个宏还可以过滤彼此过于接近的点。用户必须选择一个对象，然后使用平均法线创建该对象的副本。</p><gydF4y2Badiv class="literal-block-wrapper docutils container" id="id4"> <div class="code-block-caption"> <span class="caption-text">滤波曲线法线</gydF4y2Baspan> <a class="headerlink" href="#id4" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">这个宏显示了如何平均一个包含曲线的对象的法线。</gydF4y2Baspan><span class="c1">#这个宏也可以过滤彼此太近的点。</gydF4y2Baspan><span class="c1"># use必须选择一个对象，然后，该对象的一个副本将被平均法线创建。</gydF4y2Baspan><span class="c1">关于RoboDK API的更多信息:</gydF4y2Baspan><span class="c1">#文档://m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">#参考://m.sinclairbody.com/doc/en/PythonAPI/index.html</gydF4y2Baspan><span class="c1">#-------------------------------------------------------</gydF4y2Baspan><span class="c1">输入平均过滤器的大小，以样本数量为单位。</gydF4y2Baspan><span class="c1">#如果这个值被设置为-1，它将弹出一条消息，要求用户输入一个值</gydF4y2Baspan><span class="n">FilterNormalSamples</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">样品中#</gydF4y2Baspan><span class="c1">#输入距离，单位为mm，用于过滤近处。</gydF4y2Baspan><span class="c1">#例如，如果我们想要一个点，每2毫米最多，我们应该输入2。</gydF4y2Baspan><span class="c1">#设置为-1不过滤点数。</gydF4y2Baspan><span class="n">FilterPointDistance</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">单位:mm</gydF4y2Baspan><span class="c1"># ------------------------------------------------------</gydF4y2Baspan><span class="c1">#启动RoboDK API</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># RoboDK API</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robomath</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">#机器人工具箱</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robodialogs</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#让用户选择对象</gydF4y2Baspan><span class="n">obj</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemUserPick</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">选择要过滤曲线的对象或工具</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#我们可以选择通过ITEM_TYPE_OBJECT或ITEM_TYPE_TOOL进行过滤(不能同时使用)</gydF4y2Baspan><span class="c1">如果用户选择取消，则#退出</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">obj</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#要求用户输入滤镜大小</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">FilterNormalSamples</gydF4y2Baspan><span class="o">＜=</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">str_avg_filter</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">mbox</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">输入过滤器大小(用于平均过滤器的点/法线数)。</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s2">例如，如果过滤器大小为10个单位，则使用10个最接近的法线来平均每个法线。”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">条目</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s2">“10”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">str_avg_filter</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#用户选择取消</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#将用户输入转换为整数</gydF4y2Baspan><span class="n">FilterNormalSamples</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">str_avg_filter</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">FilterNormalSamples</gydF4y2Baspan><span class="o">＜=</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ShowMessage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“无效的过滤值。输入值>= 1"</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">味精</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">遍历所有对象曲线，提取曲线点并平均法线</gydF4y2Baspan><span class="n">curve_id</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="n">obj_filtered</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">name_feature</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">obj</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">GetPoints</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">FEATURE_CURVE</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">curve_id</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1"># points是一个双浮点数组，每个浮点数组包含np个点和xyzijk数据</gydF4y2Baspan><span class="c1"># point[np] = [x,y,z,i,j,k] #其中xyz是位置，ijk是工具方向(z轴，通常是曲面的法线)</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">当curve_id越界时，返回一个空的双数组</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="mi">6</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">打破</gydF4y2Baspan><span class="n">味精</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s2">过滤:“</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">name_feature</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">味精</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ShowMessage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">味精</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">curve_id</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">curve_id</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">#对于每个点，平均点范围内的法线[-FilterNormalSamples/2;+ FilterNormalSamples / 2)</gydF4y2Baspan><span class="n">new_normals</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［］</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">id_avg_from</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">轮</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">马克斯</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mf">0．5</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">FilterNormalSamples</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">id_avg_to</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">轮</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">最小值</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mf">0．5</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">FilterNormalSamples</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="c1">#确保我们考虑了开始和结束部分(navg通常是FilterNormalSamples，除了边界附近)</gydF4y2Baspan><span class="n">n_avg</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">id_avg_to</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">id_avg_from</gydF4y2Baspan><span class="n">normal_i</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">j</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">id_avg_from</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">id_avg_to</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">倪</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">j</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">6</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">normal_i</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">add3</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">normal_i</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">倪</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#正常化</gydF4y2Baspan><span class="n">normal_i</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">normalize3</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">normal_i</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">normal_i = mult3(normal_i, 1.0/n_avg)</gydF4y2Baspan><span class="c1">#添加新法线到列表中</gydF4y2Baspan><span class="n">new_normals</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">normal_i</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#结合法线与点列表</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">6</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">new_normals</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1">#过滤点，如果需要</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">FilterPointDistance</gydF4y2Baspan><span class="o">></gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">lastp</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="n">points_filtered</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［］</gydF4y2Baspan><span class="n">points_filtered</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="n">lastp</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">距离</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">lastp</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="o">></gydF4y2Baspan><span class="n">FilterPointDistance</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">points_filtered</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="n">lastp</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">points_filtered</gydF4y2Baspan><span class="c1">#对于第一条曲线:创建一个新对象，重命名它，并将它放在原始对象的相同位置</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">obj_filtered</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">obj_filtered</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddCurve</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">PROJECTION_NONE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">obj_filtered</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">obj</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s2">“过滤”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">obj_filtered</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParent</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">obj</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">父</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="n">obj_filtered</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setGeometryPose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">obj_filtered</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">GeometryPose</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="k">其他的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#添加第一条曲线后，将下面的曲线添加到同一个对象</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddCurve</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">obj_filtered</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">PROJECTION_NONE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#设置曲线显示宽度</gydF4y2Baspan><span class="n">obj_filtered</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setValue</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“显示”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“LINEW = 2”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#设置曲线颜色为RGBA值[0-1.0]</gydF4y2Baspan><span class="n">obj_filtered</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setColorCurve</gydF4y2Baspan><span class="p">([</gydF4y2Baspan><span class="mf">0．0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mf">0．5</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mf">1.0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mf">0.8</gydF4y2Baspan><span class="p">])</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="change-curve-normals"> <h2><span class="section-number">6.15.</gydF4y2Baspan>变化曲线法线<一个class="headerlink" href="#change-curve-normals" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子展示了如何通过改变i, j和k向量(0,0,1)来改变一个对象的曲线法线指向+Z方向。</p><gydF4y2Badiv class="literal-block-wrapper docutils container" id="id5"> <div class="code-block-caption"> <span class="caption-text">变化曲线法线</gydF4y2Baspan> <a class="headerlink" href="#id5" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">#这个脚本通过改变i,j,k向量为(0,0,1)来改变曲线的法线指向+Z方向</gydF4y2Baspan><span class="c1">#----------------------------------------</gydF4y2Baspan><span class="c1">#启动RoboDK API</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># RoboDK API</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#让用户选择对象</gydF4y2Baspan><span class="n">obj</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemUserPick</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">选择要过滤曲线的对象或工具</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#我们可以选择通过ITEM_TYPE_OBJECT或ITEM_TYPE_TOOL进行过滤(不能同时使用)</gydF4y2Baspan><span class="c1">如果用户选择取消，则#退出</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">obj</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">curve_list</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［］</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="c1">遍历所有对象曲线，提取曲线点并在列表中检索曲线</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">curve_points</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">name_feature</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">obj</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">GetPoints</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">FEATURE_CURVE</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">curve_points</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">打破</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="n">curve_list</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">curve_points</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#检索列表包含[x,y,z,i,j,k]</gydF4y2Baspan><span class="c1">#改变i,j,k向量为0,0,1</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">曲线</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">curve_list</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">idx</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">曲线</gydF4y2Baspan><span class="p">)):</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">j</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">k</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">曲线</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">idx</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">6</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">曲线</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">idx</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">6</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1">#打印(new_curve)</gydF4y2Baspan><span class="c1">#添加所有被操纵的曲线作为一个新对象</gydF4y2Baspan><span class="n">obj_new</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">曲线</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">curve_list</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">obj_new</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddCurve</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">曲线</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">obj_new</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">PROJECTION_NONE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#设置新的对象名称和父对象</gydF4y2Baspan><span class="n">obj_new</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">obj</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s2">“新”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">obj_new</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParent</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">obj</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">父</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="n">obj_new</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setGeometryPose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">obj_new</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">GeometryPose</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="c1">#设置曲线显示宽度</gydF4y2Baspan><span class="n">obj_new</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setValue</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“显示”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“LINEW = 4”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#设置曲线颜色为RGBA值[0-1.0]</gydF4y2Baspan><span class="n">obj_new</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setColorCurve</gydF4y2Baspan><span class="p">([</gydF4y2Baspan><span class="mf">0．0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mf">0．5</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mf">1.0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mf">0.8</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="c1">#删除第一次检索到的对象上的所有曲线</gydF4y2Baspan><span class="n">obj</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“DeleteCurves”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="attach-object-to-a-robot-link"> <h2><span class="section-number">6.16.</gydF4y2Baspan>将对象附加到机器人链接<一个class="headerlink" href="#attach-object-to-a-robot-link" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子展示了如何将一个对象附加到一个机器人链接。一旦您将对象放置在首选位置，您就可以在RoboDK站中运行脚本。</p><gydF4y2Badiv class="literal-block-wrapper docutils container" id="id6"> <div class="code-block-caption"> <span class="caption-text">将对象附加到机器人链接</gydF4y2Baspan> <a class="headerlink" href="#id6" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">这个脚本允许你将一个对象附加到一个机器人链接</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># API与RoboDK通信</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robodialogs</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#初始化RoboDK API</gydF4y2Baspan><span class="c1">#选择机器人</gydF4y2Baspan><span class="c1">#添加形状到机器人链接</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemUserPick</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“选择一个机器人添加一个对象”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_ROBOT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“没有选择机器人。添加一个机器人将这个几何图形连接到一个链接'</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">mbox</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“进入关节，将物体连接到:</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">例如:0是底，3是关节3'</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">条目</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“3”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">link_id</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">robotlink</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ObjectLink</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">link_id</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">robotlink</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">打破</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ShowMessage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“无效的链接。选择一个有效的机器人链接”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">对象</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemUserPick</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">选择要添加的对象</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_OBJECT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="nb">对象</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“对象未选中”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#要合并的对象列表(第一个必须是机器人链接)</gydF4y2Baspan><span class="n">合并</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">robotlink</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">对象</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1">#合并对象</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MergeItems</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">合并</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#设置原始对象不可见(或删除)</gydF4y2Baspan><span class="nb">对象</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setVisible</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1"># object.Delete ()</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="move-robot-using-a-keyboard"> <h2><span class="section-number">6.17.</gydF4y2Baspan>使用键盘移动机器人<一个class="headerlink" href="#move-robot-using-a-keyboard" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子展示了如何使用键盘移动机器人。这个宏需要作为一个单独的进程来执行，以正确地拦截键盘(不是在RoboDK内部)。这个例子可以扩展到使用<一个class="reference external" href="https://github.com/RoboDK/Plug-In-Interface/tree/master/PluginAppLoader/Apps/XboxController">的Xbox控制器</一个>W我我遥控器或其他输入设备。</p><gydF4y2Badiv class="literal-block-wrapper docutils container" id="move-a-robot-using-the-keyboard"> <div class="code-block-caption"> <span class="caption-text">使用键盘移动一个机器人</gydF4y2Baspan> <a class="headerlink" href="#move-a-robot-using-the-keyboard" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">#这个宏允许使用键盘移动机器人</gydF4y2Baspan><span class="c1">更多关于RoboDK API的信息:</gydF4y2Baspan><span class="c1"># //m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">#输入help("robodk.robolink")或help("robodk.robomath")获取更多信息</gydF4y2Baspan><span class="c1">#按F5运行脚本</gydF4y2Baspan><span class="c1">#注意:你不需要保留这个文件的副本，你的python脚本会和站点一起保存</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># API与RoboDK通信</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robomath</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">基本矩阵运算</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#方向键程序示例</gydF4y2Baspan><span class="c1">#买个机器人</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_ROBOT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“车站里没有机器人。先装一个机器人，然后运行这个程序。”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">暂停</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">5</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“车站里没有机器人!”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“使用机器人:</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“使用箭头(左，右，上，下)，Q和A键移动机器人”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">注意:这只适用于控制台模式，你必须单独运行PY文件。</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#定义移动增量</gydF4y2Baspan><span class="n">move_speed</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">10</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">msvcrt</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="n">getch</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">奥德</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">getch</gydF4y2Baspan><span class="p">()))</gydF4y2Baspan><span class="n">move_direction</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1">#打印(键)</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">75</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">'箭头向左(Y-)'</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">move_direction</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="k">elif</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">77</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">向右箭头(Y+)</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">move_direction</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="k">elif</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">72</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">'向上箭头(X-)'</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">move_direction</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="k">elif</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">80</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">箭头向下(X+)</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">move_direction</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="k">elif</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">113</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“问(Z +)”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">move_direction</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="k">elif</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">97</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“(Z)”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">move_direction</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1">#确保指定了移动方向</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">规范</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">move_direction</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＜=</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">继续</gydF4y2Baspan><span class="c1">#根据移动速度计算以mm为单位的移动</gydF4y2Baspan><span class="n">xyz_move</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">mult3</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">move_direction</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">move_speed</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#得到机器人关节</gydF4y2Baspan><span class="n">robot_joints</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#从关节获取机器人位置(计算正运动学)</gydF4y2Baspan><span class="n">robot_position</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SolveFK</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">robot_joints</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#获取机器人配置(机器人关节状态)</gydF4y2Baspan><span class="n">robot_config</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">JointsConfig</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">robot_joints</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#计算新的机器人位置</gydF4y2Baspan><span class="n">new_robot_position</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">xyz_move</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">robot_position</gydF4y2Baspan><span class="c1">#计算新的机器人关节</gydF4y2Baspan><span class="n">new_robot_joints</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SolveIK</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">new_robot_position</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">new_robot_joints</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">tolist</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="mi">6</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“没有机器人解决方案!!”新位置太遥远、够不着或太接近奇点。”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">继续</gydF4y2Baspan><span class="c1">#计算新关节的机器人配置</gydF4y2Baspan><span class="n">new_robot_config</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">JointsConfig</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">new_robot_joints</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">robot_config</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="n">new_robot_config</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">robot_config</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="n">new_robot_config</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">robot_config</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="n">new_robot_config</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">]:</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“警告! !机器人配置改变!!这将导致意想不到的运动!”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">robot_config</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">new_robot_config</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">其他的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#移动机器人关节到新位置</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">new_robot_joints</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1"># robot.MoveL (new_robot_joints)</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="connect-to-robots"> <h2><span class="section-number">6.18.</gydF4y2Baspan>连接到机器人<一个class="headerlink" href="#connect-to-robots" title="¶＂>gydF4y2Ba¶</一个></h2><p>本例展示了如何使用机器人驱动程序连接到RoboDK站中所有可用的机器人，并将机器人移动到RoboDK中设置的位置。这个例子展示了如何同时与多个机器人通信。</p><gydF4y2Badl class="simple"> <dt> 更多信息请点击这里:</gydF4y2Badt> <dd> <ul class="simple"> <li><p>使用RoboDK API为Python进行在线编程:<一个class="reference external" href="//m.sinclairbody.com/doc/en/RoboDK-API.html">//m.sinclairbody.com/doc/en/RoboDK-API.html#PythonAPIOnline</一个></p></li> <li><p>机器人司机:<一个class="reference external" href="//m.sinclairbody.com/doc/en/Robot-Drivers.html">//m.sinclairbody.com/doc/en/Robot-Drivers.html#RobotDrivers</一个></p></li> </ul> </dd> </dl> <div class="literal-block-wrapper docutils container" id="move-robots-online"> <div class="code-block-caption"> <span class="caption-text">在线移动机器人</gydF4y2Baspan> <a class="headerlink" href="#move-robots-online" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">#输入help("robodk.robolink")或help("robodk.robomath")获取更多信息</gydF4y2Baspan><span class="c1">#按F5运行脚本</gydF4y2Baspan><span class="c1">更多关于RoboDK API的信息:</gydF4y2Baspan><span class="c1"># //m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">#注意:你不需要保留这个文件的副本，你的python脚本会和站点一起保存</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># API与RoboDK通信</gydF4y2Baspan><span class="c1">#启动RoboDK API</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#收集所有机器人作为项目对象</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemList</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">ITEM_TYPE_ROBOT</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#循环遍历所有机器人并连接到机器人</gydF4y2Baspan><span class="n">错误</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">”</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">#强制断开所有机器人模拟双击</gydF4y2Baspan><span class="c1">#if count == 0:</gydF4y2Baspan><span class="c1"># robot.Disconnect ()</gydF4y2Baspan><span class="c1"># robot.Disconnect ()</gydF4y2Baspan><span class="c1">#暂停(1)</gydF4y2Baspan><span class="c1">#重要的是，每个机器人都需要一个新的API连接来允许它们在不同的线程中分别移动(如果需要的话)</gydF4y2Baspan><span class="n">rdk</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">链接</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">rdk</gydF4y2Baspan><span class="c1">#力模拟模式，如果我们已经连接到机器人。</gydF4y2Baspan><span class="c1">#然后，收集机器人的关节位置。</gydF4y2Baspan><span class="c1">#这将收集模拟机器人的位置，而不是真正的机器人。</gydF4y2Baspan><span class="n">rdk</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setRunMode</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">RUNMODE_SIMULATE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">jnts</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#连接到机器人:</gydF4y2Baspan><span class="c1"># rdk.setRunMode(RUNMODE_RUN_ROBOT) #不需要，因为连接将自动执行</gydF4y2Baspan><span class="c1"># state = robot.ConnectSafe()</gydF4y2Baspan><span class="n">状态</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">连接</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">状态</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#检查连接状态和消息</gydF4y2Baspan><span class="n">状态</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">味精</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ConnectedState</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">状态</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">味精</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">状态</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="n">ROBOTCOM_READY</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">错误</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">错误</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s1">“连接问题:”</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s1">“:”</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">味精</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="k">其他的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#移动到模拟器中的关节位置:</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">jnts</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#显示连接错误，如果有</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">错误</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">></gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">错误</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">错误</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">其他的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="monitor-joints"> <h2><span class="section-number">6.19.</gydF4y2Baspan>监控关节<一个class="headerlink" href="#monitor-joints" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子展示了如何将机器人的模拟位置保存到文本或CSV文件中。</p><gydF4y2Badiv class="literal-block-wrapper docutils container" id="monitor-simulated-joints"> <div class="code-block-caption"> <span class="caption-text">监测模拟接头</gydF4y2Baspan> <a class="headerlink" href="#monitor-simulated-joints" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">#这个宏将在CSV文件中记录机器人关节(以度为单位)(包括以秒为单位的时间戳)。该文件避免记录相同的关节两次。</gydF4y2Baspan><span class="c1">#提示:使用脚本jointsplay .py沿着记录的关节移动</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># API与RoboDK通信</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robomath</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">基本矩阵运算</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">时间</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="n">gmtime</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">strftime</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#让用户选择一个机械臂(机制被忽略)</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemUserPick</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“选择一个机器人”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_ROBOT_ARM</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“机器人不可用”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">在RDK文件所在的文件夹中生成一个文件</gydF4y2Baspan><span class="n">file_path</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“PATH_OPENSTATION”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s1">“/关节-”</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">strftime</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“% Y - % m</gydF4y2Baspan><span class="si">% d</gydF4y2Baspan><span class="s2">% % M - H - % S”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">gmtime</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s1">. csv”</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">joints_changed</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">j - 1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">j2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">宽容</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mf">0.0001</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""如果关节1和关节2不同则返回True """</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">j - 1</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">j2</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">j - 1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">j2</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">邮政编码</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">j - 1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">j2</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">腹肌</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">j - 1</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">j2</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">></gydF4y2Baspan><span class="n">宽容</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="c1">#无限循环记录机器人关节</gydF4y2Baspan><span class="n">joints_last</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“记录机器人关节文件:”</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">file_path</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">与</gydF4y2Baspan><span class="nb">开放</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">file_path</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“一个”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="n">支撑材</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">抽搐</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">时间</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">toc</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">列表</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">joints_changed</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">joints_last</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">'时间(秒):'</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="nb">str</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">时间</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">支撑材</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">写</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">str</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="p">) [</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">"，</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">时间</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">joints_last</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="n">暂停</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mf">0.01</gydF4y2Baspan><span class="p">）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="monitor-a-real-ur-robot"> <h2><span class="section-number">6.20.</gydF4y2Baspan>监控一个真实的UR机器人<一个class="headerlink" href="#monitor-a-real-ur-robot" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子展示了如何监控连接到PC的万能机器人。除此之外，机器人的位置、速度和加速度可以在125赫兹的频率下进行监测。</p><gydF4y2Badl class="simple"> <dt> 更多信息请点击这里:</gydF4y2Badt> <dd> <ul class="simple"> <li><p>机器人司机:<一个class="reference external" href="//m.sinclairbody.com/doc/en/Robot-Drivers.html">//m.sinclairbody.com/doc/en/Robot-Drivers.html#RobotDrivers</一个></p></li> <li><p>使用万能机器人的小贴士:<一个class="reference external" href="//m.sinclairbody.com/doc/en/Robots-Universal-Robots.html">//m.sinclairbody.com/doc/en/Robots-Universal-Robots.html#UR</一个></p></li> </ul> </dd> </dl> <div class="literal-block-wrapper docutils container" id="monitor-a-ur-robot"> <div class="code-block-caption"> <span class="caption-text">监控UR机器人</gydF4y2Baspan> <a class="headerlink" href="#monitor-a-ur-robot" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">#这个脚本创建一个线程来监控一个真实的UR机器人的位置和其他变量</gydF4y2Baspan><span class="c1">#这个脚本激活，RoboDK将创建一个新的目标，当机器人移动一定的公差</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">更多关于RoboDK API的信息:</gydF4y2Baspan><span class="c1"># //m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">#按F5运行脚本</gydF4y2Baspan><span class="c1">#或访问://m.sinclairbody.com/doc/en/PythonAPI/index.html</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># API与RoboDK通信</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robomath</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">#机器人工具箱</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">线程</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">套接字</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">结构体</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">操作系统</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">时间</gydF4y2Baspan><span class="c1">每次机器人位置改变时刷新屏幕</gydF4y2Baspan><span class="n">TOLERANCE_JOINTS_REFRESH</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mf">0．1</gydF4y2Baspan><span class="n">RETRIEVE_JOINTS_ONCE</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="c1">#如果为True，当前机器人位置将只被检索一次</gydF4y2Baspan><span class="c1">#创建以度为单位的公差目标</gydF4y2Baspan><span class="n">CREATE_TARGETS</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="n">TOLERANCE_JOINTS_NEWTARGET</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">10</gydF4y2Baspan><span class="c1">以度为单位</gydF4y2Baspan><span class="n">REFRESH_RATE</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mf">0.01</gydF4y2Baspan><span class="c1">#使当前机器人关节可访问，以防我们在单独的线程上运行它</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">ROBOT_JOINTS</gydF4y2Baspan><span class="c1">#检查机器人关节位置是否根据一定公差不同的程序</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">Robot_Joints_Check</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">晶澳</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简森-巴顿</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">tolerance_deg</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">晶澳</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">6</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">腹肌</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">晶澳</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">简森-巴顿</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="o">></gydF4y2Baspan><span class="n">tolerance_deg</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">180</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="c1">#########################################################################</gydF4y2Baspan><span class="c1"># Byte移位指向数据包中正确的字节数据</gydF4y2Baspan><span class="n">UR_GET_TIME</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="n">UR_GET_JOINT_POSITIONS</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">252</gydF4y2Baspan><span class="n">UR_GET_JOINT_SPEEDS</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">300</gydF4y2Baspan><span class="n">UR_GET_JOINT_CURRENTS</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">348</gydF4y2Baspan><span class="n">UR_GET_TCP_FORCES</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">540</gydF4y2Baspan><span class="c1">#根据字节数组获取数据包大小</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">packet_size</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">缓冲区</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">缓冲区</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="n">结构体</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">。</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">"！我”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">缓冲区</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">) [</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1">检查数据包是否完整</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">packet_check</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">缓冲区</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">msg_sz</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">packet_size</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">缓冲区</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">缓冲区</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="n">msg_sz</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">"数据包大小不正确</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s2">vs</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">msg_sz</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">缓冲区</gydF4y2Baspan><span class="p">）））</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="c1">#从数据包中获取特定信息</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">packet_value</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">缓冲区</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">抵消</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">造船</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">6</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">缓冲区</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="n">抵消</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">造船</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“没有偏移量(可能是旧版本的Polyscope ?):</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s2">-</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">缓冲区</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="n">抵消</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="nb">格式</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“!”</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">造船</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="nb">格式</gydF4y2Baspan><span class="o">+ =</gydF4y2Baspan><span class="s1">' d '</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="nb">列表</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">结构体</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">。</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">格式</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">缓冲区</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">抵消</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="c1">#返回列表(struct.unpack_from”!Dddddd "， buf, offset))</gydF4y2Baspan><span class="c1">#当新数据包到达时采取的操作</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">on_packet</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">包</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">ROBOT_JOINTS</gydF4y2Baspan><span class="c1">从数据包中检索所需的信息</gydF4y2Baspan><span class="n">rob_joints_RAD</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">packet_value</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">包</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">UR_GET_JOINT_POSITIONS</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">ROBOT_JOINTS</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">霁</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="mf">180.0</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">霁</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">rob_joints_RAD</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1">#ROBOT_SPEED = packet_value(数据包，ur_get_joint_speed)</gydF4y2Baspan><span class="c1">#ROBOT_CURRENT = packet_value(数据包，UR_GET_JOINT_CURRENTS)</gydF4y2Baspan><span class="c1">#打印(ROBOT_JOINTS)</gydF4y2Baspan><span class="c1">#监视线程从机器人检索信息</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">UR_Monitor</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">rt_socket</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">套接字</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">create_connection</gydF4y2Baspan><span class="p">（(</gydF4y2Baspan><span class="n">ROBOT_IP</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ROBOT_PORT</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">缓冲区</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="sa">b</gydF4y2Baspan><span class="s1">”</gydF4y2Baspan><span class="n">packet_count</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="n">packet_time_last</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">时间</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">时间</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">更多的</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">rt_socket</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">recv</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">4096</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">更多的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">缓冲区</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">缓冲区</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">更多的</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">packet_check</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">缓冲区</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">packet_len</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">packet_size</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">缓冲区</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">包</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">缓冲区</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">缓冲区</gydF4y2Baspan><span class="p">[:</gydF4y2Baspan><span class="n">packet_len</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">缓冲区</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">packet_len</gydF4y2Baspan><span class="p">:]</gydF4y2Baspan><span class="n">on_packet</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">包</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">packet_count</gydF4y2Baspan><span class="o">+ =</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">packet_count</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="mi">125</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">t_now</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">时间</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">时间</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“监视</gydF4y2Baspan><span class="si">% .1f</gydF4y2Baspan><span class="s2">每秒包数"</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">packet_count</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">t_now</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">packet_time_last</gydF4y2Baspan><span class="p">）））</gydF4y2Baspan><span class="n">packet_count</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="n">packet_time_last</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">t_now</gydF4y2Baspan><span class="n">rt_socket</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">关闭</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#########################################################################</gydF4y2Baspan><span class="c1">#输入RoboDK IP和端口</gydF4y2Baspan><span class="n">ROBOT_IP</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="c1">#“192.168.2.31”</gydF4y2Baspan><span class="n">ROBOT_PORT</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">30003</gydF4y2Baspan><span class="c1">#启动RoboDK API</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#找回机器人</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemUserPick</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“选择一个UR机器人来检索当前位置”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_ROBOT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#找回机器人的IP:</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">ROBOT_IP</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">知识产权</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">港口</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">路径</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ftpuser</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ftppass</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ConnectionParams</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">ROBOT_IP</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">知识产权</gydF4y2Baspan><span class="n">ROBOT_JOINTS</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="n">last_joints_target</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="n">last_joints_refresh</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="c1">#启动Robot Monitor线程</gydF4y2Baspan><span class="c1">#q = queue.Queue()</gydF4y2Baspan><span class="n">t</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">线程</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">线程</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">UR_Monitor</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">t</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">守护进程</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="n">t</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">开始</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1"># UR_Monitor ()</gydF4y2Baspan><span class="c1">#启动主循环刷新RoboDK并自动创建目标/程序</gydF4y2Baspan><span class="n">target_count</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#等待一个有效的机器人关节读取</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">ROBOT_JOINTS</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">继续</gydF4y2Baspan><span class="c1">#设置机器人到该位置</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">Robot_Joints_Check</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">last_joints_refresh</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ROBOT_JOINTS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">TOLERANCE_JOINTS_REFRESH</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">last_joints_refresh</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">ROBOT_JOINTS</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setJoints</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">ROBOT_JOINTS</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">如果我们只需要当前位置，则在此停止</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">RETRIEVE_JOINTS_ONCE</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#检查机器人是否移动到足以创建一个新目标</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">CREATE_TARGETS</gydF4y2Baspan><span class="ow">而且</gydF4y2Baspan><span class="n">Robot_Joints_Check</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">last_joints_target</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ROBOT_JOINTS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">TOLERANCE_JOINTS_NEWTARGET</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">last_joints_target</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">ROBOT_JOINTS</gydF4y2Baspan><span class="n">target_count</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">target_count</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="n">newtarget</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddTarget</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">不</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">target_count</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#休息一会儿</gydF4y2Baspan><span class="n">暂停</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">REFRESH_RATE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="pick-and-place"> <h2><span class="section-number">6.21.</gydF4y2Baspan>挑选和放置<一个class="headerlink" href="#pick-and-place" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子展示了一个使用Fanuc M-710iC/50机器人的高级取放应用程序(来自RoboDK库的示例2)。</p><p>gydF4y2Ba在本例中，发那科机器人的所有机器人运动都由Python程序管理。使用Python API可以创建、移动、修改和删除站中的任何对象、参考系、机器人或其他项目。</p><gydF4y2Badiv class="literal-block-wrapper docutils container" id="example-02-1-pick-and-place-with-python"> <div class="code-block-caption"> <span class="caption-text">例02-1 -用python选择和放置</gydF4y2Baspan> <a class="headerlink" href="#example-02-1-pick-and-place-with-python" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">输入help("robolink")或help("robodk")查看更多信息</gydF4y2Baspan><span class="c1">#按F5运行脚本</gydF4y2Baspan><span class="c1">#文档://m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">#参考://m.sinclairbody.com/doc/en/PythonAPI/index.html</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">这个例子展示了一个使用发那科M-710iC/50机器人的高级取放应用程序(来自RoboDK库的例子2)</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># API与RoboDK通信，用于模拟和离线/在线编程</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robomath</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">#机器人工具箱</gydF4y2Baspan><span class="c1">#设置全局参数</gydF4y2Baspan><span class="n">BALL_DIAMETER</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="c1">一个球的直径</gydF4y2Baspan><span class="n">方法</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="c1">#抓取各部分的接近距离，单位:mm</gydF4y2Baspan><span class="n">nTCPs</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">6</gydF4y2Baspan><span class="c1">#工具中TCP的数量</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#函数定义</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">box_calc</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">BALLS_SIDE</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">BALLS_MAX</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""计算一个点的列表(球的中心)，就好像球被存储在一个盒子里"""</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">BALLS_MAX</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">BALLS_MAX</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">BALLS_SIDE</gydF4y2Baspan><span class="o">**</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="n">xyz_list</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［］</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">BALLS_SIDE</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">BALLS_SIDE</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">j</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">BALLS_SIDE</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">xyz_list</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">xyz_list</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="p">[[(</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mf">0．5</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">BALL_DIAMETER</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">j</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mf">0．5</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">BALL_DIAMETER</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mf">0．5</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">BALL_DIAMETER</gydF4y2Baspan><span class="p">]]</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">xyz_list</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">> =</gydF4y2Baspan><span class="n">BALLS_MAX</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="n">xyz_list</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="n">xyz_list</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">pyramid_calc</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">BALLS_SIDE</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""计算一个点的列表(球中心)，就像把球放在金字塔里一样"""</gydF4y2Baspan><span class="c1">#球的数量可以计算为int(BALLS_SIDE*(BALLS_SIDE+1)*(2*BALLS_SIDE+1)/6)</gydF4y2Baspan><span class="n">BALL_DIAMETER</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="n">xyz_list</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［］</gydF4y2Baspan><span class="n">sqrt2</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="o">**</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mf">0．5</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">BALLS_SIDE</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">BALLS_SIDE</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">j</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">BALLS_SIDE</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">高度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">BALL_DIAMETER</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="n">sqrt2</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">BALL_DIAMETER</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="n">xyz_list</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">xyz_list</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="p">[[</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">BALL_DIAMETER</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">BALL_DIAMETER</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="mf">0．5</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">j</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">BALL_DIAMETER</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">BALL_DIAMETER</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="mf">0．5</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">高度</gydF4y2Baspan><span class="p">]]</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="n">xyz_list</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">balls_setup</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">职位</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""在参考系中放置一个球的列表。引用对象(球)必须先前已复制到剪贴板。”＂＂</gydF4y2Baspan><span class="n">nballs</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">职位</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">一步</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mf">1.0</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">nballs</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">nballs</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">newball</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">粘贴</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">newball</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“球”</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="nb">str</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="c1">#设置项目名称</gydF4y2Baspan><span class="n">newball</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">职位</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">)))</gydF4y2Baspan><span class="c1">#设置项目相对于父元素的位置</gydF4y2Baspan><span class="n">newball</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setVisible</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#使项目可见，但隐藏参考框架</gydF4y2Baspan><span class="n">newball</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">重新着色</gydF4y2Baspan><span class="p">([</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">一步</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">一步</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mf">0.2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="c1">#设置RGBA颜色</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">cleanup_balls</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">parentnodes</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""从提供的父项列表中删除所有名称以"ball "开头的子项。"＂＂</gydF4y2Baspan><span class="n">删除</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［］</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">parentnodes</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">删除</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">删除</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">蔡尔兹</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">删除</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">startswith</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“球”</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">删除</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">TCP_On</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">toolitem</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">tcp_id</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">将最近的对象附加到toolitem工具姿态，</gydF4y2Baspan><span class="sd">此外，它将对生成的机器人程序输出适当的函数调用(对TCP_On的调用)”＂＂</gydF4y2Baspan><span class="n">toolitem</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AttachClosest</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">toolitem</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">RunMessage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">设定空气阀</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">在“</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">tcp_id</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">toolitem</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">调用</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“TCP_On (</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">)”</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">tcp_id</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">TCP_Off</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">toolitem</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">tcp_id</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">itemleave</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">分离连接到toolitem工具位姿的最近对象，</gydF4y2Baspan><span class="sd">此外，它将对生成的机器人程序输出适当的函数调用(调用TCP_Off)”＂＂</gydF4y2Baspan><span class="n">toolitem</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">DetachAll</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">itemleave</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">toolitem</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">RunMessage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">设定空气阀</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">了”</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">tcp_id</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">toolitem</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">调用</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“TCP_Off (</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">)”</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">tcp_id</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="c1">#----------------------------------------------------------</gydF4y2Baspan><span class="c1">#程序从这里开始:</gydF4y2Baspan><span class="c1">#任何与RoboDK的交互都必须通过RDK完成:</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#关闭自动渲染(更快)</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">渲染</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1"># RDK.Set_Simulation_Speed (500);#设置模拟速度</gydF4y2Baspan><span class="c1">从车站树中收集所需物品</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“Fanuc 50 m - 710 ic /”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">robot_tools</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">蔡尔兹</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1"># robotool = RDK.Item('MainTool')</gydF4y2Baspan><span class="n">第一帧</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“表1”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">frame2</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“表2”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">复制一个球作为对象(CTRL+C相同)</gydF4y2Baspan><span class="n">ballref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“参考球”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">ballref</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">复制</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#运行一个预先定义的站程序(在RoboDK中)来替换这两个表</gydF4y2Baspan><span class="n">prog_reset</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“替换对象”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">prog_reset</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">调用</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#调用自定义过程删除旧对象</gydF4y2Baspan><span class="n">cleanup_balls</gydF4y2Baspan><span class="p">([</gydF4y2Baspan><span class="n">第一帧</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">frame2</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="c1">#列出放置物体的位置</gydF4y2Baspan><span class="n">frame1_list</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">pyramid_calc</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">frame2_list</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">pyramid_calc</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">使用定制的过程以编程方式放置对象</gydF4y2Baspan><span class="n">balls_setup</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">第一帧</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">frame1_list</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#删除之前生成的工具</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">工具</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">robot_tools</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">工具</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">startswith</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“TCP”</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">工具</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">删除</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">计算6个吸盘工具的刀架</gydF4y2Baspan><span class="n">TCP_list</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［］</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">nTCPs</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">TCPi_pose</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">rotz</gydF4y2Baspan><span class="p">（(</gydF4y2Baspan><span class="mi">360</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="n">nTCPs</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">180</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">125</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">roty</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">TCPi</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddTool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">TCPi_pose</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“TCP</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">TCP_list</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">TCPi</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">TCP_0</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">TCP_list</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1">#打开自动渲染</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">渲染</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#移动球</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseTool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">TCP_list</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="n">nballs_frame1</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">frame1_list</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">nballs_frame2</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">frame2_list</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">idTake</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">nballs_frame1</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="n">idLeave</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="n">idTCP</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="n">target_app_frame</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">BALL_DIAMETER</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">BALL_DIAMETER</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">BALL_DIAMETER</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">roty</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">方法</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="n">idTake</gydF4y2Baspan><span class="o">> =</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1"># ------------------------------------------------------------------</gydF4y2Baspan><span class="c1">#首要任务:抓住尽可能多的球</gydF4y2Baspan><span class="c1">#此时工具是空的，所以尽可能多的取球(最多6 ->个nTCPs)</gydF4y2Baspan><span class="n">ntake</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">最小值</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">nTCPs</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">idTake</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#方法到帧1</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">第一帧</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseTool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">TCP_0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">([</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">10</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">200</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">target_app_frame</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#从第一帧抓取球</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">ntake</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">TCPi</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">TCP_list</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseTool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">TCPi</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#计算目标wrt帧1:由于Z轴和X轴是反向的，所以需要绕Y轴旋转</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">frame1_list</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">idTake</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">roty</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">rotx</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">30.</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">180</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">target_app</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">方法</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">idTake</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">idTake</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">target_app</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">TCP_On</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">TCPi</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">target_app</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1"># ------------------------------------------------------------------</gydF4y2Baspan><span class="c1">#第二优先级:卸载工具</gydF4y2Baspan><span class="c1">#方法到框架2，并将工具球放入表2</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseTool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">TCP_0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">target_app_frame</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">([</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">10</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">200</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">frame2</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">target_app_frame</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">ntake</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">TCPi</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">TCP_list</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseTool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">TCPi</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">idLeave</gydF4y2Baspan><span class="o">></gydF4y2Baspan><span class="n">nballs_frame2</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“没有空间来放置表2中的对象”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#计算目标wrt帧1:由于Z轴和X轴是反向的，所以需要绕Y旋转180</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">frame2_list</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">idLeave</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">roty</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">rotx</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">30.</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">180</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">target_app</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">方法</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">idLeave</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">idLeave</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">target_app</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">TCP_Off</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">TCPi</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">frame2</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">target_app</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">target_app_frame</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">机器人完成后就搬回家</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">([</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">10</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">200</gydF4y2Baspan><span class="p">])</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="update-machining-tools"> <h2><span class="section-number">6.22.</gydF4y2Baspan>更新加工工具<一个class="headerlink" href="#update-machining-tools" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个脚本将更新所有在工具名中有Length标志的工具(例如:<gydF4y2Baem>工具L220.551</gydF4y2Baem>)的参考工具。参考工具必须有一个参考长度(例如:calibrb Point L164.033)。这对于指定一个铣刀或相对于参考刀具定义一个特定的铣刀是有用的。</p><我米g一个lt="_images / Tool-Point-Offset.png＂src="//m.sinclairbody.com/doc/en/PythonAPI/_images/Tool-Point-Offset.png"> <div class="literal-block-wrapper docutils container" id="update-robot-machining-tools"> <div class="code-block-caption"> <span class="caption-text">更新机器人加工工具</gydF4y2Baspan> <a class="headerlink" href="#update-robot-machining-tools" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">这个宏将更新所有在工具名(工具L220.551)中有长度标志的工具。</gydF4y2Baspan><span class="c1">参考工具必须有一个参考长度(例如:calibrb Point L164.033)。</gydF4y2Baspan><span class="c1">#这是有用的指定一个对峙或定义一个特定的铣刀相对于参考工具。</gydF4y2Baspan><span class="c1">#提示:定义第一个长度为0的工具示例:主轴L0，它将被放置在刀架的根部</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">更多关于RoboDK API的信息:</gydF4y2Baspan><span class="c1"># //m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">更多信息请访问:</gydF4y2Baspan><span class="c1"># //m.sinclairbody.com/doc/en/PythonAPI/robodk.html robolink-py</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># RoboDK API</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robomath</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">#机器人工具箱</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robodialogs</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">#引用工具的名字(RoboDK树中的名字)</gydF4y2Baspan><span class="c1">名称必须包含以mm为单位的长度</gydF4y2Baspan><span class="n">TOOL_NAME_REF</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“校准点L164.033”</gydF4y2Baspan><span class="c1">#根据工具名称和L关键字获取标称工具长度</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">get_len_tool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">toolname</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">toolnamelist</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">toolname</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">分裂</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">”“</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">toolnamelist</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">startswith</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“L”</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="k">试一试</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">len_tcp_definition</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">浮动</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">:])</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="n">len_tcp_definition</gydF4y2Baspan><span class="k">除了</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">"无法转换单词:"</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="nb">str</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="k">继续</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“警告!未知的长度”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="c1">#启动API</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">检索引用工具并确保它存在</gydF4y2Baspan><span class="n">tcpref1</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">TOOL_NAME_REF</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_TOOL</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">tcpref1</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">引用TCP不存在</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#获取参考长度</gydF4y2Baspan><span class="n">len_ref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">get_len_tool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">tcpref1</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">len_ref</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">参考长度未指定，假设为0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">len_ref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="c1">#检索两个工具的姿态</gydF4y2Baspan><span class="n">pose1</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">tcpref1</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">PoseTool</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">遍历所有工具</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">tcpref2</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">tcpref1</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">父</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">蔡尔兹</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">tcpref2</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">类型</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="n">ITEM_TYPE_TOOL</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#不是工具项，跳过</gydF4y2Baspan><span class="k">继续</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">tcpref1</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="n">tcpref2</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#这是同一个工具，跳过</gydF4y2Baspan><span class="k">继续</gydF4y2Baspan><span class="c1">#获取工具姿势</gydF4y2Baspan><span class="n">pose2</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">tcpref2</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">PoseTool</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#检索当前关系:</gydF4y2Baspan><span class="n">pose_shift</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">invH</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">pose1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">pose2</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">y</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">z</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">p</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">r</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Pose_2_TxyzRxyz</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">pose_shift</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">保存沿着Z轴的新偏移量的变量</gydF4y2Baspan><span class="n">newZ</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="n">toolname</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">tcpref2</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">len_tcp_definition</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">get_len_tool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">toolname</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">len_tcp_definition</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“没有L长度的跳过工具:”</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">toolname</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">继续</gydF4y2Baspan><span class="c1">#根据“L”命名计算偏移量:</gydF4y2Baspan><span class="n">nominal_offset</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">len_tcp_definition</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">len_ref</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">消息</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">的工具:</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="se">\ n \ n</gydF4y2Baspan><span class="s1">输入新的Z偏移量(mm)</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">电流偏移量为:</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">toolname</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">z</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">腹肌</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">nominal_offset</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">z</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">></gydF4y2Baspan><span class="mf">0.001</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">消息</gydF4y2Baspan><span class="o">+ =</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="se">\ n \ n</gydF4y2Baspan><span class="s1">注意:</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">标称偏移量(</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">-</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">)：</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">毫米</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">vs。</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">当前偏移量:</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">毫米</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">不匹配”</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">len_tcp_definition</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">len_ref</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">nominal_offset</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">z</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">其他的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">消息</gydF4y2Baspan><span class="o">+ =</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">偏移量当前匹配</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">腹肌</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">></gydF4y2Baspan><span class="mf">0.001</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="nb">腹肌</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">y</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">></gydF4y2Baspan><span class="mf">0.001</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="nb">腹肌</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">></gydF4y2Baspan><span class="mf">0.001</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="nb">腹肌</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">p</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">></gydF4y2Baspan><span class="mf">0.001</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="nb">腹肌</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">r</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">></gydF4y2Baspan><span class="mf">0.001</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">消息</gydF4y2Baspan><span class="o">+ =</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="se">\ n \ n</gydF4y2Baspan><span class="s1">重要提示:电流偏置:</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">[X, Y, Z, W, P, R] = [</gydF4y2Baspan><span class="si">% .2f</gydF4y2Baspan><span class="s1">，</gydF4y2Baspan><span class="si">% .2f</gydF4y2Baspan><span class="s1">，</gydF4y2Baspan><span class="si">% .2f</gydF4y2Baspan><span class="s1">，</gydF4y2Baspan><span class="si">% .2f</gydF4y2Baspan><span class="s1">，</gydF4y2Baspan><span class="si">% .2f</gydF4y2Baspan><span class="s1">，</gydF4y2Baspan><span class="si">% .2f</gydF4y2Baspan><span class="s1">]“</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">y</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">z</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">p</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">r</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">mbox</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">消息</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">条目</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">-</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">len_tcp_definition</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">len_ref</gydF4y2Baspan><span class="p">）））</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“用户取消”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#退出()#停止</gydF4y2Baspan><span class="k">打破</gydF4y2Baspan><span class="c1">#转到下一个</gydF4y2Baspan><span class="k">试一试</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">newZ</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">eval</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#浮动(值)</gydF4y2Baspan><span class="k">打破</gydF4y2Baspan><span class="k">除了</gydF4y2Baspan><span class="ne">ValueError</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“这不是数字，再试一次”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">如果计算出偏移量，则更新工具</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">newZ</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">pose_newtool</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">pose1</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">newZ</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">tcpref2</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseTool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">pose_newtool</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“完成。姿态设置为:"</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">pose_newtool</gydF4y2Baspan><span class="p">）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="project-tcp-to-axis"> <h2><span class="section-number">6.23.</gydF4y2Baspan>项目TCP到Axis<一个class="headerlink" href="#project-tcp-to-axis" title="¶＂>gydF4y2Ba¶</一个></h2><p>该脚本将一个工具(TCP)投射到由其他两个校准工具(定义一个轴的两个TCP)定义的轴上。这个脚本还会调整工具方向(Z轴)以匹配校准的轴。在更新TCP之前，将显示一个弹出窗口来提供工具错误。</p><p>gydF4y2Ba如果需要精确计算主轴的点和轴(例如，用于机器人加工或切割)，此脚本非常有用。</p><我米g一个lt="_images / Tool-Projection.png＂src="//m.sinclairbody.com/doc/en/PythonAPI/_images/Tool-Projection.png"> <div class="literal-block-wrapper docutils container" id="tool-tcp-to-axis-projection"> <div class="code-block-caption"> <span class="caption-text">工具(TCP)向轴投影</gydF4y2Baspan> <a class="headerlink" href="#tool-tcp-to-axis-projection" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">#该脚本将一个TCP投影到由其他两个TCP定义的轴上。</gydF4y2Baspan><span class="c1">#沿着两个校准TCP所定义的线调整TCP和Z轴的位置</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">更多关于RoboDK API的信息:</gydF4y2Baspan><span class="c1"># //m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">更多信息请访问:</gydF4y2Baspan><span class="c1"># //m.sinclairbody.com/doc/en/PythonAPI/robodk.html robolink-py</gydF4y2Baspan><span class="c1">#输入校准的参考工具(Z+定义为Point1到Point2)</gydF4y2Baspan><span class="n">AXIS_POINT_1</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“CalibTool 1”</gydF4y2Baspan><span class="n">AXIS_POINT_2</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">《CalibTool 2》</gydF4y2Baspan><span class="c1">#将下面的变量设置为False，不移动TCP</gydF4y2Baspan><span class="c1">#(只需要调整Z轴的方向)</gydF4y2Baspan><span class="n">PROJECT_POINT</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="c1">#-----------------------------------------------------------------</gydF4y2Baspan><span class="c1">#-----------------------------------------------------------------</gydF4y2Baspan><span class="c1">#-----------------------------------------------------------------</gydF4y2Baspan><span class="c1">#-----------------------------------------------------------------</gydF4y2Baspan><span class="c1">#-----------------------------------------------------------------</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># API与RoboDK通信</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robomath</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">基本矩阵运算</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robodialogs</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#获取TCP到项目</gydF4y2Baspan><span class="n">tcpitem</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemUserPick</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">选择工具校准Z轴</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_TOOL</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">tcpitem</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">H_TCP</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">tcpitem</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">PoseTool</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">P_TCP</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">H_TCP</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Pos</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#获取主轴轴</gydF4y2Baspan><span class="n">tcp_item_1</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">AXIS_POINT_1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_TOOL</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">tcp_item_2</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">AXIS_POINT_2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_TOOL</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">tcp_item_1</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">定义第一个校准TCP为:</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">AXIS_POINT_1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">tcp_item_2</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">定义第二个校准TCP为:</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">AXIS_POINT_2</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">axis_p1</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">tcp_item_1</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">PoseTool</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Pos</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">axis_p2</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">tcp_item_2</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">PoseTool</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Pos</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1"># P_TCP可选手动输入:</gydF4y2Baspan><span class="c1"># p_tcp = [-51.240000， -94.004000, 266.281000, 60.150000, 0.000000， -26.760000] # [2,0,10]</gydF4y2Baspan><span class="c1"># H_TCP = Motoman_2_Pose(P_TCP)</gydF4y2Baspan><span class="c1">#主轴可选择手动输入</gydF4y2Baspan><span class="c1"># axis_p1 = (-43.74331, -83.59345, 259.19644) # (0, 0, 0)</gydF4y2Baspan><span class="c1"># axis_p2 = (-56.48556, -107.99492, 274.96115) # [0, 0, 1]</gydF4y2Baspan><span class="n">axis_v12</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">normalize3</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">subs3</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">axis_p2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">axis_p1</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="c1"># TCP计算</gydF4y2Baspan><span class="n">TCP_OK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">proj_pt_2_line</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">P_TCP</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">axis_p1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">axis_v12</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">TCP_verror</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">subs3</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">P_TCP</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">TCP_OK</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">投影到主轴轴的TCP:</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">[x, y, z] = [</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">，</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">，</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">]毫米的</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">TCP_OK</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">TCP_OK</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">TCP_OK</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">)))</gydF4y2Baspan><span class="n">msg_proj_error</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">投影错误=</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">毫米的</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">规范</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">TCP_verror</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">msg_proj_error</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1"># TCP参考帧调整(正确的Z轴)</gydF4y2Baspan><span class="n">TCP_Yvect</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">H_TCP</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">v</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">TCP_Zvect</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">H_TCP</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">VZ</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">angle_error</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">angle3</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">axis_v12</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">TCP_Zvect</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="mi">180</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="n">msg_angle_error</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">'Z角误差=</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">度的</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">angle_error</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">msg_angle_error</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">H_TCP_OK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">眼睛</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">PROJECT_POINT</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">H_TCP_OK</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">TCP_OK</gydF4y2Baspan><span class="k">其他的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">H_TCP_OK</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">P_TCP</gydF4y2Baspan><span class="n">H_TCP_OK</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">axis_v12</gydF4y2Baspan><span class="n">x_axis</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">normalize3</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">交叉</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">TCP_Yvect</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">axis_v12</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">y_axis</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">normalize3</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">交叉</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">axis_v12</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">x_axis</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">H_TCP_OK</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">x_axis</gydF4y2Baspan><span class="n">H_TCP_OK</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">y_axis</gydF4y2Baspan><span class="n">TCP_OK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Pose_2_Motoman</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">H_TCP_OK</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">msg_newtcp</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">'更新的TCP [X,Y,Z,w,p,r] = [</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">，</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">，</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">，</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">，</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">，</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">]“</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">TCP_OK</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">TCP_OK</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">TCP_OK</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">TCP_OK</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">TCP_OK</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">TCP_OK</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">5</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">msg_newtcp</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#请求用户更新TCP</gydF4y2Baspan><span class="n">回答</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">mbox</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">msg_newtcp</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="se">\ n \ n</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">msg_proj_error</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">msg_angle_error</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="se">\ n \ n</gydF4y2Baspan><span class="s1">更新TCP ?”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">回答</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">tcpitem</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseTool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">H_TCP_OK</gydF4y2Baspan><span class="p">）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="robot-machining-settings"> <h2><span class="section-number">6.24.</gydF4y2Baspan>机器人加工设置<一个class="headerlink" href="#robot-machining-settings" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子展示了如何使用RoboDK API修改与机器人加工和程序事件相关的设置。</p><p>gydF4y2Ba双击机器人加工项目、曲线跟踪项目、点跟踪项目或3D打印项目，即可查看设置。</p><p>gydF4y2Ba选择<gydF4y2Baem>项目活动</gydF4y2Baem>看事件。</p><p>gydF4y2Ba下一节将展示如何更改轴优化设置(当机器人与外部轴结合时可能需要)。</p><我米g一个lt="_images / RobotMachining.png＂src="//m.sinclairbody.com/doc/en/PythonAPI/_images/RobotMachining.png"> <p>可以使用parameter/命令将变量检索或设置为字典或JSON字符串<strgydF4y2Baong>加工</strgydF4y2Baong>而且<strgydF4y2Baong>ProgEvents</strgydF4y2Baong>如下例所示。</p><gydF4y2Badiv class="literal-block-wrapper docutils container" id="update-robot-machining-settings"> <div class="code-block-caption"> <span class="caption-text">更新机器人加工设置</gydF4y2Baspan> <a class="headerlink" href="#update-robot-machining-settings" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">这个例子展示了如何使用RoboDK API修改与机器人加工和程序事件相关的设置。</gydF4y2Baspan><span class="c1">双击机器人加工项目、曲线跟踪项目、点跟踪项目或3D打印项目查看设置。</gydF4y2Baspan><span class="c1">#选择*程序事件*查看事件。</gydF4y2Baspan><span class="c1">更多信息:</gydF4y2Baspan><span class="c1"># //m.sinclairbody.com/doc/en/PythonAPI/examples.html robot-machining-settings</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># RoboDK API</gydF4y2Baspan><span class="c1"># JSON工具</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">json</gydF4y2Baspan><span class="c1">#让用户选择一个机器人加工项目</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">米</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemUserPick</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“选择一个机器人加工项目来改变方法/撤回”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_MACHINING</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">米</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“添加机器人加工项目，曲线跟踪或点跟踪”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#获取该机器人加工项目使用的机器人:</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">米</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getLink</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">ITEM_TYPE_ROBOT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“未选择机器人:为这个机器人加工项目选择一个机器人”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#--------------------------------------------</gydF4y2Baspan><span class="c1">#获取或设置首选起始关节:</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">米</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">JointsHome</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“首选启动接头:”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">列表</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="n">米</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setJoints</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#获取或设置工具姿态的路径:</gydF4y2Baspan><span class="n">path2tool</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">米</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“工具姿势路径:”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">path2tool</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">米</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">path2tool</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#获取或设置工具/参考框架:</gydF4y2Baspan><span class="n">工具</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">米</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getLink</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">ITEM_TYPE_TOOL</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“使用工具:”</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">工具</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">米</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getLink</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">ITEM_TYPE_FRAME</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“使用参考:”</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">框架</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="c1"># m.setPoseFrame(框架)</gydF4y2Baspan><span class="c1"># m.setPoseTool(工具)</gydF4y2Baspan><span class="c1">#--------------------------------------------</gydF4y2Baspan><span class="c1">获取或设置机器人加工参数</gydF4y2Baspan><span class="c1">#读取所选加工项目的程序事件设置</gydF4y2Baspan><span class="n">machiningsettings</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">米</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“加工”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“机器人加工设置:”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">json</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">转储</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">machiningsettings</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">缩进</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="c1">#--------------------------------------------</gydF4y2Baspan><span class="c1">#读取所选加工项目的程序事件设置</gydF4y2Baspan><span class="n">progevents</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">米</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“ProgEvents”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“程序”事件:</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">json</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">转储</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">progevents</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">缩进</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="c1">#读取程序事件设置默认使用</gydF4y2Baspan><span class="c1">#station = RDK.ActiveStation()</gydF4y2Baspan><span class="c1">#json_data = station.setParam("ProgEvents")</gydF4y2Baspan><span class="c1">#json_object = json.loads(json_data)</gydF4y2Baspan><span class="c1">#打印(json。转储（json_object, indent=4))</span><span class="c1">机器人加工设置样本字典</gydF4y2Baspan><span class="n">MachiningSettings</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">｛</gydF4y2Baspan><span class="s2">“算法”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="c1"># 0:最小的刀具方向变化，1:刀具方向遵循路径</gydF4y2Baspan><span class="s2">“ApproachRetractAll”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“自动更新”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AvoidCollisions”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“FollowAngle”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">45</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“FollowAngleOn”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“FollowRealign”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">10</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“FollowRealignOn”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“FollowStep”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">90</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“FollowStepOn”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“JoinCurvesTol”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mf">0．5</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“OrientXaxis2_X”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“OrientXaxis2_Y”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“OrientXaxis2_Z”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“OrientXaxis_X”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“OrientXaxis_Y”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“OrientXaxis_Z”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“PointApproach”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">20.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“RapidApproachRetract”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“RotZ_Range”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">180</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“RotZ_Step”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">20.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“SpeedOperation”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">50</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“SpeedRapid”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1000</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“TrackActive”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“TrackOffset”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“TrackVector_X”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“TrackVector_Y”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“TrackVector_Z”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“TurntableActive”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“TurntableOffset”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“TurntableRZcomp”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“VisibleNormals”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">｝</gydF4y2Baspan><span class="c1">程序事件的样本字典</gydF4y2Baspan><span class="n">MachiningProgEvents</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">｛</gydF4y2Baspan><span class="s2">“CallAction”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="s2">“onPoint”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“CallActionOn”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“CallApproach”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="s2">“onApproach”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“CallApproachOn”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“CallPathFinish”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="s2">“SpindleOff”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“CallPathFinishOn”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“CallPathStart”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="s2">“SpindleOn”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“CallPathStartOn”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“CallProgFinish”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="s2">“onFinish”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“CallProgFinishOn”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“CallProgStart”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="s2">“ChangeTool(%) %工具”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“CallProgStartOn”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“CallRetract”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="s2">“onRetract”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“CallRetractOn”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“挤压机”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="s2">“挤出机(% 1)”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“IO_Off”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="s2">“默认”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“IO_OffMotion”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="s2">“OutOffMov(% 1)”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“IO_On”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="s2">“默认”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“IO_OnMotion”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="s2">“OutOnMov(% 1)”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“Mcode”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="s2">“M_RunCode(% 1)”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“RapidSpeed”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1000</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="c1">#快速移动到/从路径</gydF4y2Baspan><span class="s2">“四舍五入”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="c1">#混合半径</gydF4y2Baspan><span class="s2">“RoundingOn”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“SpindleCCW”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="s2">＂＂</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“SpindleCW”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="s2">＂＂</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“SpindleRPM”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="s2">“SetRPM(% 1)”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“ToolChange”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="s2">“SetTool(% 1)”</gydF4y2Baspan><span class="p">｝</gydF4y2Baspan><span class="c1">#更新一个值，例如，使法线不可见</gydF4y2Baspan><span class="n">MachiningUpdate</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">{}</gydF4y2Baspan><span class="n">MachiningUpdate</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s2">“VisibleNormals”</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="n">MachiningUpdate</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s2">“自动更新”</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="n">MachiningUpdate</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s2">“RotZ_Range”</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“更新机器人加工设置”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">状态</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">米</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“加工”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">MachiningUpdate</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">状态</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#更新一些值，例如，设置自定义工具更改和设置arc start和arc end命令</gydF4y2Baspan><span class="n">ProgEventsUpdate</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">{}</gydF4y2Baspan><span class="n">ProgEventsUpdate</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s2">“ToolChange”</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s2">“ChangeTool(% 1)”</gydF4y2Baspan><span class="n">ProgEventsUpdate</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s2">“CallPathStart”</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s2">“ArcStart(1)”</gydF4y2Baspan><span class="n">ProgEventsUpdate</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s2">“CallPathStartOn”</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="n">ProgEventsUpdate</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s2">“CallPathFinish”</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s2">“ArcEnd()”</gydF4y2Baspan><span class="n">ProgEventsUpdate</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s2">“CallPathFinishOn”</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“更新程序事件”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">状态</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">米</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“ProgEvents”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ProgEventsUpdate</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">状态</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#---------------------------------------------------------------------------</gydF4y2Baspan><span class="c1">本节展示如何更改机器人加工项目的接近/收回设置</gydF4y2Baspan><span class="c1">单位为毫米和度</gydF4y2Baspan><span class="c1">更多示例:C:/RoboDK/Library/Macros/SampleApproachRetract.py</gydF4y2Baspan><span class="c1">#应用切线方法并收缩(单位:mm)</gydF4y2Baspan><span class="n">米</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“ApproachRetract”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“切50”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1"># m。集Param("Approach", "Tangent 50")</span><span class="c1"># m。集Param("Retract", "Tangent 50")</span><span class="c1"># m。集Param("Retract", "Side 100") # side approach</span><span class="c1"># m。集Param("Approach", "XYZ 50 60 70") # XYZ offset</span><span class="c1"># m。集Param("Approach", "NTS 50 60 70") #Normal/Tangent/Side Coordinates</span><span class="c1"># m。集Param("ApproachRetract", "ArcN 50 100") # Normal arc (diameter/angle)</span><span class="n">米</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“UpdatePath”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#重新计算工具路径</gydF4y2Baspan><span class="c1">更新加工项目(验证机器人的可行性)</gydF4y2Baspan><span class="n">状态</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">米</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">更新</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#获取生成的机器人程序</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">米</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getLink</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">ITEM_TYPE_PROGRAM</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#运行程序模拟</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">调用</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#保存程序文件到指定文件夹</gydF4y2Baspan><span class="c1"># program.MakeProgram (" " " C: / Path-to-Folder / " " ")</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="axes-optimization-settings"> <h2><span class="section-number">6.25.</gydF4y2Baspan>优化设置<一个class="headerlink" href="#axes-optimization-settings" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子展示了如何使用RoboDK API和JSON字符串读取或修改Axes Optimization设置。您可以在机器人加工菜单中选择“轴优化”或机器人参数，查看轴优化设置。可以手动或使用API更新附加到机器人或机器人加工项目的轴优化设置。</p><我米g一个lt="_images / AxesOptimization.png＂src="//m.sinclairbody.com/doc/en/PythonAPI/_images/AxesOptimization.png"> <p>可以使用parameter/命令将变量检索或设置为字典或JSON字符串<strgydF4y2Baong>OptimAxes</strgydF4y2Baong>如下例所示。</p><gydF4y2Badiv class="literal-block-wrapper docutils container" id="update-axes-optimization-settings"> <div class="code-block-caption"> <span class="caption-text">更新轴优化设置</gydF4y2Baspan> <a class="headerlink" href="#update-axes-optimization-settings" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">这个例子展示了如何使用RoboDK API和JSON字符串读取或修改Axes Optimization设置。</gydF4y2Baspan><span class="c1">#你可以在机器人加工菜单中选择“轴优化”或机器人参数来查看轴优化设置。</gydF4y2Baspan><span class="c1">#可以手动或使用API更新附加到机器人或机器人加工项目的轴优化设置。</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">更多关于RoboDK API的信息:</gydF4y2Baspan><span class="c1"># //m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">更多信息请访问:</gydF4y2Baspan><span class="c1"># //m.sinclairbody.com/doc/en/PythonAPI/robodk.html robolink-py</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># RoboDK API</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robomath</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># JSON工具</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">json</gydF4y2Baspan><span class="c1">#启动RoboDK API</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#让用户选择一个机械臂(6轴机器人，可以有外轴)</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemUserPick</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“选择机械臂”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_ROBOT_ARM</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#默认优化设置测试模板</gydF4y2Baspan><span class="n">AxesOptimSettings</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">｛</gydF4y2Baspan><span class="c1">#优化参数:</gydF4y2Baspan><span class="s2">“活跃”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="c1">#使用通用轴优化:0=禁用或1=启用</gydF4y2Baspan><span class="s2">“算法”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="c1">#优化算法使用:1=Nelder Mead, 2=样品，3=样品+Nelder Mead</gydF4y2Baspan><span class="s2">“麦克斯特”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">650</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="c1">#马克斯。迭代次数</gydF4y2Baspan><span class="s2">“托尔”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mf">0.0016</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="c1">#允许停止迭代</gydF4y2Baspan><span class="c1">#绝对参考接头(双):</gydF4y2Baspan><span class="s2">“AbsJnt_1”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mf">104.17</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AbsJnt_2”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mf">11.22</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AbsJnt_3”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mf">15.97</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AbsJnt_4”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mf">87.48</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AbsJnt_5”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mf">75.36</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AbsJnt_6”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mf">63.03</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AbsJnt_7”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mf">174.13</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AbsJnt_8”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mf">173.60</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AbsJnt_9”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="c1">#使用绝对参考关节(0:No, 1: Yes):</gydF4y2Baspan><span class="s2">“AbsOn_1”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AbsOn_2”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AbsOn_3”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AbsOn_4”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AbsOn_5”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AbsOn_6”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AbsOn_7”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AbsOn_8”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AbsOn_9”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="c1">绝对参考接头重量(双):</gydF4y2Baspan><span class="s2">“AbsW_1”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AbsW_2”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AbsW_3”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AbsW_4”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">89</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AbsW_5”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">90</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AbsW_6”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">92</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AbsW_7”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">92</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AbsW_8”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">96</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“AbsW_9”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">50</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="c1">#用于相对关节运动平滑(0:否，1:是):</gydF4y2Baspan><span class="s2">“RelOn_1”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“RelOn_2”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“RelOn_3”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“RelOn_4”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“RelOn_5”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“RelOn_6”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“RelOn_7”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“RelOn_8”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“RelOn_9”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="c1">相对关节运动的重量(双):</gydF4y2Baspan><span class="s2">“RelW_1”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">5</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“RelW_2”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">47</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“RelW_3”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">44</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“RelW_4”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">43</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“RelW_5”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">36</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“RelW_6”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">47</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“RelW_7”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">53</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“RelW_8”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">59</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“RelW_9”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="p">｝</gydF4y2Baspan><span class="c1">#更新一个值，例如，使它激活:</gydF4y2Baspan><span class="n">更新</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">{}</gydF4y2Baspan><span class="n">更新</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s2">“活跃”</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="n">json_str</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">json</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">转储</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">更新</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">状态</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“OptimAxes”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">json_str</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">状态</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">进行部分或全部更新的示例</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">7</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="c1">#部分更新</gydF4y2Baspan><span class="n">更新</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">{}</gydF4y2Baspan><span class="n">更新</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s2">“AbsJnt_”</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="nb">str</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">)]</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="n">更新</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s2">“AbsOn_”</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="nb">str</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">)]</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="n">更新</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s2">“AbsW_”</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="nb">str</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">)]</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">json_str</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">json</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">转储</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">更新</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">状态</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“OptimAxes”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">json_str</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">状态</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#全面更新</gydF4y2Baspan><span class="c1"># OptimAxes_TEST[“RefJoint_”+ str (i + 1) =(计数+ i) * 4</gydF4y2Baspan><span class="c1">#OptimAxes_TEST["RefWeight_" + str(i+1)] = (count+i)</gydF4y2Baspan><span class="c1">#OptimAxes_TEST["RefOn_" + str(i+1)] = count % 2</gydF4y2Baspan><span class="c1">#全面更新</gydF4y2Baspan><span class="c1">#打印(机器人。setParam（“OptimAxes”，str（AxesOptimSettings）））</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">#读取设置</gydF4y2Baspan><span class="n">json_data</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“OptimAxes”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">json_object</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">json</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">加载</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">json_data</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">json</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">转储</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">json_object</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">缩进</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">暂停</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mf">0.2</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">读取当前轴优化设置的示例:</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">json_data</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“OptimAxes”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">json_object</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">json</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">加载</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">json_data</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">json</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">转储</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">json_object</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">缩进</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">暂停</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mf">0.2</gydF4y2Baspan><span class="p">）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="modify-program-instructions"> <h2><span class="section-number">6.26.</gydF4y2Baspan>修改程序说明<一个class="headerlink" href="#modify-program-instructions" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子展示了如何修改程序指令。</p><p>gydF4y2Ba这个例子遍历选定的程序，改变速度，删除任何暂停指令，并添加自定义程序调用。</p><gydF4y2Badiv class="literal-block-wrapper docutils container" id="id7"> <div class="code-block-caption"> <span class="caption-text">修改程序指令</gydF4y2Baspan> <a class="headerlink" href="#id7" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">这个例子展示了如何修改程序指令</gydF4y2Baspan><span class="c1">#另见:</gydF4y2Baspan><span class="c1"># //m.sinclairbody.com/doc/en/PythonAPI/robodk.html robodk.robolink.Robolink.AddProgram</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># API与RoboDK通信</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">json</gydF4y2Baspan><span class="c1">#启动RoboDK API</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#让用户选择一个程序:</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemUserPick</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“选择要修改的程序”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_PROGRAM</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">"操作取消或无节目可用"</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#要求用户输入一个函数调用，在每次移动后添加:</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">"所选项目:"</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="c1">对所有指令进行迭代(索引起始为0，也可以对最后一条指令使用-1)</gydF4y2Baspan><span class="n">ins_count</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">InstructionCount</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">ins_id</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="n">ins_id</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="n">ins_count</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#获取与指令相关的特定数据</gydF4y2Baspan><span class="c1">#这个操作总是返回一个dict (json)</gydF4y2Baspan><span class="n">instruction_dict</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">ins_id</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#打印指令数据</gydF4y2Baspan><span class="c1">#indented_values = json。转储（我n结构体ion＿dict, indent=4)</span><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="se">\ n \ n</gydF4y2Baspan><span class="s2">指令:“</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="nb">str</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">ins_id</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">instruction_dict</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#注意:每条指令的类型都是唯一的，不能更改。</gydF4y2Baspan><span class="c1">#但是，将Type值设置为-1将删除指令(与InstructionDelete()相同)</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">instruction_dict</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s1">“类型”</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="n">INS_TYPE_CHANGESPEED</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">降低速度:</gydF4y2Baspan><span class="n">newvalues</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">｛</gydF4y2Baspan><span class="s1">“速度”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">50</gydF4y2Baspan><span class="p">｝</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">instruction_dict</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s1">“速度”</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">></gydF4y2Baspan><span class="mi">50</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">new_speed</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mf">0.8</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">instruction_dict</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s1">“速度”</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">newvalues</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">｛</gydF4y2Baspan><span class="s1">“速度”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">new_speed</gydF4y2Baspan><span class="p">｝</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">将速度降低到:</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">new_speed</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#更新指令数据</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">ins_id</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">newvalues</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">如果您不提供新名称，# RoboDK可能会更改指令名</gydF4y2Baspan><span class="k">elif</gydF4y2Baspan><span class="n">instruction_dict</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s1">“类型”</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="n">INS_TYPE_CODE</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#选择移动指令作为添加新指令的参考</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">InstructionSelect</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">ins_id</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#添加一个新的程序调用</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">RunInstruction</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“职位”</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">instruction_dict</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s1">“代码”</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">INSTRUCTION_CALL_PROGRAM</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">重要提示:我们刚刚添加了一条新指令，所以请确保我们跳过这个指令索引!</gydF4y2Baspan><span class="n">ins_id</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">ins_id</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="k">elif</gydF4y2Baspan><span class="n">instruction_dict</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s1">“类型”</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="n">INS_TYPE_PAUSE</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“删除暂停指令”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">掠夺</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">InstructionDelete</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">ins_id</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#删除指令的另一种方式:</gydF4y2Baspan><span class="c1">#delete_command = {'Type':-1}</gydF4y2Baspan><span class="c1">#掠夺。集Param(ins_id, delete_command)</span><span class="c1">重点:我们刚刚删除了一条指令，所以要确保我们重新计算了指令索引</gydF4y2Baspan><span class="n">ins_id</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">ins_id</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="k">elif</gydF4y2Baspan><span class="n">instruction_dict</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s1">“类型”</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="n">INS_TYPE_MOVE</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">移动指令:使用setInstruction修改目标</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#ins_name, ins_type, move_type, isjointtarget, pose，关节= program . instruction (ins_id)</gydF4y2Baspan><span class="c1">#掠夺。集Instruction(ins_id, ins_name, ins_type, move_type, isjointtarget, pose, joints)</span><span class="n">ins_id</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">ins_id</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">#删除为新指令自动创建的选择</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setSelection</gydF4y2Baspan><span class="p">([])</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="drawing-an-svg-image"> <h2><span class="section-number">6.27.</gydF4y2Baspan>绘制SVG图像<一个class="headerlink" href="#drawing-an-svg-image" title="¶＂>gydF4y2Ba¶</一个></h2><p>给出一个SVG图像来编程一个机器人来模拟绘图应用程序。本例中使用ABB IRB 4600-20/2.50。</p><p>gydF4y2Ba这个例子的3D HTML模拟:<一个class="reference external" href="//m.sinclairbody.com/simulations/Robot-Drawing.html">//m.sinclairbody.com/simulations/Robot-Drawing.html</一个></p><div class="literal-block-wrapper docutils container" id="example-03-drawing-with-a-robot"> <div class="code-block-caption"> <span class="caption-text">例03 -用机器人画画</gydF4y2Baspan> <a class="headerlink" href="#example-03-drawing-with-a-robot" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">输入help("robolink")或help("robodk")查看更多信息</gydF4y2Baspan><span class="c1">#按F5运行脚本</gydF4y2Baspan><span class="c1">#文档://m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">#参考://m.sinclairbody.com/doc/en/PythonAPI/index.html</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">#机器人编程给定SVG图像来模拟绘图应用程序。本例中使用ABB IRB 4600-20/2.50。</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># API与RoboDK通信，用于模拟和离线/在线编程</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robomath</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">#工业机器人工具箱世界杯2022美洲预选赛直播</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">sys</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">操作系统</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">再保险</gydF4y2Baspan><span class="c1">#--------------------------------------------------------------------------------</gydF4y2Baspan><span class="c1">#函数定义:</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">point2D_2_pose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">切</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""在XY平面上将2D点转换为3D姿态(4x4齐次矩阵)"＂＂</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">y</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">rotz</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">切</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">角</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">svg_draw_quick</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">svg_img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">董事会</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">pix_ref</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""快速显示图像结果，无需检查机器人运动。"＂＂</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">渲染</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">路径</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">svg_img</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">#使用像素参考设置路径颜色，设置像素宽度和复制作为参考</gydF4y2Baspan><span class="n">pix_ref</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">重新着色</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">路径</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">fill_color</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">路径</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">nPoints</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“画路径</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">/</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">svg_img</gydF4y2Baspan><span class="p">）））</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">p_i</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">路径</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getPoint</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">v_i</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">路径</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getVector</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">pt_pose</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">point2D_2_pose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">p_i</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">v_i</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#添加像素几何到绘图板对象，在计算的像素姿态</gydF4y2Baspan><span class="n">董事会</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddGeometry</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">pix_ref</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">pt_pose</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">渲染</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">svg_draw_robot</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">svg_img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">董事会</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">pix_ref</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">item_frame</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">item_tool</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""用机器人绘制图像。它比svg_draw_quick慢，但它确保了机器人可以绘制图像。”＂＂</gydF4y2Baspan><span class="n">方法</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="c1">#每条路径的接近距离(单位:MM)</gydF4y2Baspan><span class="n">home_joints</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">90</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1">#家庭关节，在度数</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">item_frame</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseTool</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">item_tool</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">home_joints</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#根据工具在home位置的方向获得目标方向</gydF4y2Baspan><span class="n">orient_frame2tool</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">invH</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">item_frame</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SolveFK</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">home_joints</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">item_tool</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">orient_frame2tool</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">垫</gydF4y2Baspan><span class="p">([</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="c1"># alternative: orient_frame2tool = roty(pi)</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">路径</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">svg_img</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#使用像素参考设置路径颜色，设置像素宽度和复制作为参考</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“画</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s1">， RGB color = [</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">，</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">，</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">]“</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">路径</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">idname</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">路径</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">fill_color</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">路径</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">fill_color</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">路径</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">fill_color</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">)))</gydF4y2Baspan><span class="n">pix_ref</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">重新着色</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">路径</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">fill_color</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">路径</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">nPoints</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#机器人移动:接近第一个目标</gydF4y2Baspan><span class="n">p_0</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">路径</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getPoint</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">target0</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">p_0</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">p_0</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">y</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">orient_frame2tool</gydF4y2Baspan><span class="n">target0_app</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">target0</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">方法</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">target0_app</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">RunMessage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“画</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">路径</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">idname</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">调用</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“SetColorRGB (</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">，</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">，</gydF4y2Baspan><span class="si">% .3f</gydF4y2Baspan><span class="s1">)”</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">路径</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">fill_color</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">路径</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">fill_color</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">路径</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">fill_color</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">)))</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">p_i</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">路径</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getPoint</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">v_i</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">路径</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getVector</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">pt_pose</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">point2D_2_pose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">p_i</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">v_i</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#机器人运动:</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">p_i</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">p_i</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">y</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">orient_frame2tool</gydF4y2Baspan><span class="c1">保持工具方向不变</gydF4y2Baspan><span class="c1">#target = pt_pose*orient_frame2tool #沿着路径移动工具(轴6可能达到极限)</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">创建一个计算出的像素姿态的新像素对象</gydF4y2Baspan><span class="n">董事会</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddGeometry</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">pix_ref</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">pt_pose</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">target_app</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">方法</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">target_app</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">home_joints</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#--------------------------------------------------------------------------------</gydF4y2Baspan><span class="c1">#程序启动</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#定位并导入svgpy模块</gydF4y2Baspan><span class="n">path_stationfile</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“PATH_OPENSTATION”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">sys</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">路径</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">操作系统</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">路径</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">abspath</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">path_stationfile</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="c1">#临时添加导入站点模块的路径</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">svgpy.svg</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">选择要绘制的文件</gydF4y2Baspan><span class="n">svgfile</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">path_stationfile</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s1">' /世界map.svg '</gydF4y2Baspan><span class="c1">#svgfile = path_stationfile + '/RoboDK text.svg'</gydF4y2Baspan><span class="c1">#导入SVG文件</gydF4y2Baspan><span class="n">svgdata</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">svg_load</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">svgfile</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">IMAGE_SIZE</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">1000</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">2000</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#图片大小(MM</gydF4y2Baspan><span class="n">MM_X_PIXEL</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">10</gydF4y2Baspan><span class="c1">#(单位:mm)将被切割的路径取决于像素的大小</gydF4y2Baspan><span class="n">svgdata</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">calc_polygon_fit</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">IMAGE_SIZE</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">MM_X_PIXEL</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">size_img</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">svgdata</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">size_poly</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#返回当前多边形的大小</gydF4y2Baspan><span class="c1">#获取机器人，框架和工具对象</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">' abb irb 4600-20/2.50'</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">framedraw</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“帧画”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">tooldraw</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“工具”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#获取要绘制的像素引用</gydF4y2Baspan><span class="n">pixel_ref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“像素”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#删除之前的图片</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“董事会和图像”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="ow">而且</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">类型</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="n">ITEM_TYPE_OBJECT</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">删除</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">在对象参考“Blackboard 250mm”的基础上制作一个画板</gydF4y2Baspan><span class="n">board_1m</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">黑板上250毫米的</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">board_1m</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">复制</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">board_draw</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">framedraw</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">粘贴</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">board_draw</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“董事会和图像”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">board_draw</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">规模</gydF4y2Baspan><span class="p">([</gydF4y2Baspan><span class="n">size_img</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">250</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">size_img</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">y</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">250</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="c1">#调整板尺寸到图像大小(缩放)</gydF4y2Baspan><span class="c1">#快速显示最终结果而不检查机器人的运动:</gydF4y2Baspan><span class="c1">#svg_draw_quick(svgdata, board_draw, pixel_ref)</gydF4y2Baspan><span class="c1">#用机器人绘制图像:</gydF4y2Baspan><span class="n">svg_draw_robot</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">svgdata</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">board_draw</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">pixel_ref</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">framedraw</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">tooldraw</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="p">）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="synchronize-3-robots"> <h2><span class="section-number">6.28.</gydF4y2Baspan>同步3机器人<一个class="headerlink" href="#synchronize-3-robots" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子展示了如何同时同步多个机器人。给定关键点并使用Python线程，机器人可以一起同步。这个例子类似于<一个class="reference internal" href="#weldexample"><span class="std std-ref">2022世界杯8强赛时间</span></a>但升级后支持同时移动多个机器人。机器人可以使用适当的机器人驱动程序连接到计算机，并从模拟切换到移动真正的机器人。</p><gydF4y2Badiv class="literal-block-wrapper docutils container" id="offline-programming-3-robots-simultaneously"> <div class="code-block-caption"> <span class="caption-text">2022世界杯8强赛时间离线编程- 3个机器人同时进行</gydF4y2Baspan> <a class="headerlink" href="#offline-programming-3-robots-simultaneously" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">输入help("robolink")或help("robodk")查看更多信息</gydF4y2Baspan><span class="c1">#按F5运行脚本</gydF4y2Baspan><span class="c1">#文档://m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">#参考://m.sinclairbody.com/doc/en/PythonAPI/index.html</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">这个例子展示了同时同步多个机器人</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># API与RoboDK通信，用于离线/在线编程</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robomath</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">#机器人工具箱</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">线程</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">队列</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#函数定义和全局变量声明</gydF4y2Baspan><span class="c1">#用于同步机器人运动的全局变量</gydF4y2Baspan><span class="c1">这些变量由SyncSet()和SynchWait()管理</gydF4y2Baspan><span class="n">SYNC_COUNT</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="n">SYNC_TOTAL</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="n">SYNC_ID</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="n">锁</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">线程</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">锁</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">SyncSet</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">total_sync</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">SyncSet将设置必须一起同步的机器人程序(线程)的总数。</gydF4y2Baspan><span class="sd">每次调用SyncSet, SYNC_ID都会加1。”＂＂</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">SYNC_COUNT</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">SYNC_TOTAL</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">SYNC_ID</gydF4y2Baspan><span class="k">与</gydF4y2Baspan><span class="n">锁</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">SYNC_COUNT</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="n">SYNC_TOTAL</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">total_sync</gydF4y2Baspan><span class="n">SYNC_ID</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">SYNC_ID</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">#打印(“SyncSet”)</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">SyncWait</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="sd">"""SyncWait会在必要时阻止机器人的运动，按顺序同步机器人的运动。</gydF4y2Baspan><span class="sd">使用SyncSet(nrobots)来定义必须同步多少个机器人。＂＂</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">SYNC_COUNT</gydF4y2Baspan><span class="c1">保存同步事件id的本地变量</gydF4y2Baspan><span class="n">sync_id</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">SYNC_ID</gydF4y2Baspan><span class="k">与</gydF4y2Baspan><span class="n">锁</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">增加同步线程的数量</gydF4y2Baspan><span class="n">SYNC_COUNT</gydF4y2Baspan><span class="o">+ =</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">如果所有线程都到达SyncWait (SYNC_COUNT = SYNC_TOTAL)，则转移到下一个同步事件</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">SYNC_COUNT</gydF4y2Baspan><span class="o">> =</gydF4y2Baspan><span class="n">SYNC_TOTAL</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">SyncSet</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">SYNC_TOTAL</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="c1">#等待同步集向前移动</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="n">sync_id</gydF4y2Baspan><span class="o">> =</gydF4y2Baspan><span class="n">SYNC_ID</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">时间</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">睡眠</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mf">0.0001</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#移动每个机器人的主要程序</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">DoWeld</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">问</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">robotname</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="c1">#与RoboDK的任何交互都必须通过Robolink()完成</gydF4y2Baspan><span class="c1">#每次机器人移动都需要一个新的Robolink()对象(新的通信链接)。</gydF4y2Baspan><span class="c1">两个机器人不能通过同一个通信链路移动。</gydF4y2Baspan><span class="n">rdk</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#获取机器人项目:</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">rdk</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">robotname</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#获得home关节目标</gydF4y2Baspan><span class="n">首页</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">JointsHome</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#获取参考焊接目标:</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">rdk</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“目标”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#获取参考系并将其设置为机器人</gydF4y2Baspan><span class="n">参考</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">父</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPoseFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参考</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#获取目标的姿态(4x4矩阵):</gydF4y2Baspan><span class="n">poseref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">pose_approach</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">poseref</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#移动机器人到home，然后到中心:</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">首页</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">pose_approach</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">SyncWait</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#做一个六边形围绕中心:</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">7</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">盎</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">6</gydF4y2Baspan><span class="c1">#角度:0,60,120，…</gydF4y2Baspan><span class="n">posei</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">poseref</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">rotz</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">盎</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">200</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">rotz</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">盎</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">SyncWait</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">posei</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#回到中心，然后回家:</gydF4y2Baspan><span class="n">SyncWait</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveL</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">pose_approach</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">MoveJ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">首页</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">问</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">把</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“机器人</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s1">完成的</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">robotname</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------</gydF4y2Baspan><span class="c1"># Python程序启动</gydF4y2Baspan><span class="c1">#检索RoboDK站中所有可用的机器人(以名称列表的形式)</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemList</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">ITEM_TYPE_ROBOT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#检索需要同步的机器人数量</gydF4y2Baspan><span class="n">nrobots</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">SyncSet</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">nrobots</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#队列允许线程之间共享消息</gydF4y2Baspan><span class="n">问</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">队列</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">队列</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#启动所有机器人的DoWeld程序。每个机器人将在单独的线程上运行。</gydF4y2Baspan><span class="n">线程</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［］</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">nrobots</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">robotname</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">t</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">线程</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">线程</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">目标</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">DoWeld</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">arg游戏</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">问</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">robotname</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">t</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">守护进程</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="n">t</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">开始</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">线程</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">t</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#等待每个头完成</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">线程</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">加入</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">问</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">得到</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“主程序完成”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="robot-model-dh"> <h2><span class="section-number">6.29.</gydF4y2Baspan>机器人模型(DH)<一个class="headerlink" href="#robot-model-dh" title="¶＂>gydF4y2Ba¶</一个></h2><p>本示例使用RoboDK API for Python对ABB IRB 120机器人的正运动学和逆运动学建模。参考框架是根据现有的机器人在站。</p><gydF4y2Badiv class="literal-block-wrapper docutils container" id="robot-model-mirror-test"> <div class="code-block-caption"> <span class="caption-text">机器人模型-镜像测试</gydF4y2Baspan> <a class="headerlink" href="#robot-model-mirror-test" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">输入help("robolink")或help("robodk")查看更多信息</gydF4y2Baspan><span class="c1">#按F5运行脚本</gydF4y2Baspan><span class="c1">#文档://m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">#参考://m.sinclairbody.com/doc/en/PythonAPI/index.html</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">本例使用RoboDK API for Python对ABB IRB 120机器人的正运动学和逆运动学建模</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># API与RoboDK通信，用于模拟和离线/在线编程</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robomath</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">#机器人工具箱</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#函数定义</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">FK_Robot</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">dh_table</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""计算机器人的正运动学。</gydF4y2Baspan><span class="sd">Dh_table必须以毫米和弧度为单位，关节数组必须以度为单位。”＂＂</gydF4y2Baspan><span class="n">赤潮</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［］</gydF4y2Baspan><span class="n">Hrel</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［］</gydF4y2Baspan><span class="n">nlinks</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">dh_table</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">HiAbs</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">眼睛</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">nlinks</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">rz</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">tx</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">tz</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">处方</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">dh_table</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">rz</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">rz</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">180</gydF4y2Baspan><span class="n">嗨</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">dh</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">rz</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">tx</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">tz</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">处方</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">HiAbs</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">HiAbs</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">嗨</gydF4y2Baspan><span class="n">Hrel</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">嗨</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">赤潮</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">HiAbs</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">HiAbs</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">赤潮</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">Hrel</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">Frames_setup_absolute</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">frameparent</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">nframes</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">将nframes引用帧添加到framepparent中"""</gydF4y2Baspan><span class="n">帧</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［］</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">nframes</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">newframe</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">frameparent</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">的框架</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="n">frameparent</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">newframe</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">帧</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">newframe</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="n">帧</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">Frames_setup_relative</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">frameparent</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">nframes</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">添加nframes参考帧级联到framparent """</gydF4y2Baspan><span class="n">帧</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［］</gydF4y2Baspan><span class="n">父</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">frameparent</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">nframes</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">newframe</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">frameparent</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">的框架</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="n">父</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">父</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">newframe</gydF4y2Baspan><span class="n">newframe</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">帧</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">newframe</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="n">帧</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">Set_Items_Pose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">itemlist</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">poselist</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">设置项目列表中每个项目的姿势(3D位置)"""</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">邮政编码</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">itemlist</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">poselist</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">are_equal</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">j - 1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">j2</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">如果j1和j2相等，则返回True，否则返回False """</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">j - 1</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">j2</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="n">sum_diffs_abs</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">总和</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">腹肌</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">一个</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">b</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">一个</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">b</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">邮政编码</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">j - 1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">j2</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">sum_diffs_abs</gydF4y2Baspan><span class="o">></gydF4y2Baspan><span class="mf">1 e - 3</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="c1">#----------------------------------------------------------</gydF4y2Baspan><span class="c1">#程序从这里开始:</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#-----------------------------------------------------</gydF4y2Baspan><span class="c1">机器人# DH表:ABB IRB 120-3/0.6</gydF4y2Baspan><span class="n">DH_Table</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［］</gydF4y2Baspan><span class="c1"># rZ (theta)， tX, tZ, rX (alpha)</gydF4y2Baspan><span class="n">DH_Table</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">([</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">290</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">90</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">180</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="n">DH_Table</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">([</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">90</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">180</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">270</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="n">DH_Table</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">([</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">70</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">90</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">180</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="n">DH_Table</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">([</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">302</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">90</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">180</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="n">DH_Table</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">([</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">90</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">180</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="n">DH_Table</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">([</gydF4y2Baspan><span class="mi">180</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">180</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">72</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="c1">#自由度:(ABB IRB 120-3/0.6为6)</gydF4y2Baspan><span class="n">自由度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">DH_Table</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#获取机器人:</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">' abb irb 120-3/0.6'</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#清除以前测试中包含“镜像测试”的所有项</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">删除</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“机器人基地”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#确保找到一个项目</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">删除</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">打破</gydF4y2Baspan><span class="c1">#只删除帧</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">删除</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">类型</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="n">ITEM_TYPE_FRAME</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">的删除:</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">删除</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="n">删除</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">删除</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#设置测试的父帧:</gydF4y2Baspan><span class="n">parent_frameabs</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“机器人基础(绝对帧)”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">parent_framerel</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“机器人基座(相对帧)”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#设置测试的子帧:</gydF4y2Baspan><span class="n">frames_abs</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Frames_setup_absolute</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">parent_frameabs</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">自由度</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">frames_rel</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Frames_setup_relative</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">parent_framerel</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">自由度</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">记住必要时要更新的最后一个机器人关节</gydF4y2Baspan><span class="n">last_joints</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="c1">#无限循环</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#获取当前机器人关节为浮动数组(list)</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">机器人</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">tolist</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">如果关节与之前相同，则不更新</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">are_equal</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">last_joints</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="k">继续</gydF4y2Baspan><span class="c1">#如果关节改变，计算该位置的正运动学</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">Hrobot</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">HabsList</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">HrelList</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">FK_Robot</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">DH_Table</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#在我们更新所有帧时关闭渲染:</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">渲染</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#更新所有帧</gydF4y2Baspan><span class="n">Set_Items_Pose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">frames_abs</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">HabsList</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">Set_Items_Pose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">frames_rel</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">HrelList</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1"># render并打开渲染</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">渲染</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#记住最后的机器人关节</gydF4y2Baspan><span class="n">last_joints</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“目前的机器人关节:”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">关节</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">机器人的姿态(正运动学):</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">Hrobot</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="se">\ n \ n</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="p">）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="camera-live-stream"> <h2><span class="section-number">6.30.</gydF4y2Baspan>摄像头直播<一个class="headerlink" href="#camera-live-stream" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子演示了使用Python的RoboDK API管理2D相机的一些基本功能。它创建或重用现有相机，设置其参数，使用两种不同的方法获取图像，并将其作为实时流显示给用户。这是计算机视觉算法的一个很好的起点。</p><gydF4y2Badiv class="literal-block-wrapper docutils container" id="id8"> <div class="code-block-caption"> <span class="caption-text">摄像头直播</gydF4y2Baspan> <a class="headerlink" href="#id8" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">#输入help("robodk.robolink")或help("robodk.robomath")获取更多信息</gydF4y2Baspan><span class="c1">#按F5运行脚本</gydF4y2Baspan><span class="c1">#文档://m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">#参考://m.sinclairbody.com/doc/en/PythonAPI/index.html</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">这个例子演示了使用Python的RoboDK API处理2D相机的一些基本功能。</gydF4y2Baspan><span class="c1">#它创建/重用现有的相机，设置其参数，使用两种不同的方法获取图像，并将其作为实时流显示给用户。</gydF4y2Baspan><span class="c1">#这是计算机视觉算法的一个很好的起点。</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="n">robolink</gydF4y2Baspan><span class="c1"># RoboDK API</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="n">robomath</gydF4y2Baspan><span class="c1">#机器人工具箱</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">robolink</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1"># OpenCV是一个开源的计算机视觉工具包，你可以用它来过滤和分析图像</gydF4y2Baspan><span class="n">robolink</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">import_install</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“cv2”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“opencv-python”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">robolink</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">import_install</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“numpy”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">numpy</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="nn">np</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">cv2</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="nn">简历</gydF4y2Baspan><span class="n">CAM_NAME</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“我的镜头”</gydF4y2Baspan><span class="n">CAM_PARAMS</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">的大小= 640 x480 '</gydF4y2Baspan><span class="c1">更多选项请参见//m.sinclairbody.com/doc/en/PythonAPI/robodk.html#robodk.robolink.Robolink.Cam2D_Add</gydF4y2Baspan><span class="n">WINDOW_NAME</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“我的相机馈送”</gydF4y2Baspan><span class="c1">#----------------------------------</gydF4y2Baspan><span class="c1">#获取相机项目</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">CAM_NAME</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">robolink</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ITEM_TYPE_CAMERA</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Cam2D_Add</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">CAM_NAME</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s1">“帧”</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="n">CAM_PARAMS</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">CAM_NAME</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“开放”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------</gydF4y2Baspan><span class="c1">#创建实时提要</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“isOpen”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="s1">' 1 '</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#----------------------------------</gydF4y2Baspan><span class="c1">#方法1:通过socket获取相机图像</gydF4y2Baspan><span class="n">img_socket</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="n">bytes_img</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Cam2D_Snapshot</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">isinstance</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">bytes_img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">字节</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="ow">而且</gydF4y2Baspan><span class="n">bytes_img</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="sa">b</gydF4y2Baspan><span class="s1">”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">nparr</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">frombuffer</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">bytes_img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">uint8</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">img_socket</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">imdecode</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">nparr</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">IMREAD_COLOR</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">img_socket</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">打破</gydF4y2Baspan><span class="c1">#----------------------------------</gydF4y2Baspan><span class="c1">#方法2:从磁盘获取相机图像</gydF4y2Baspan><span class="n">img_png</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">tempfile</gydF4y2Baspan><span class="k">与</gydF4y2Baspan><span class="n">tempfile</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">TemporaryDirectory</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">前缀</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“robodk_”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="n">道明</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">特遣部队</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">道明</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s1">' / temp.png '</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Cam2D_Snapshot</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">特遣部队</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">img_png</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">imread</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">特遣部队</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">img_png</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">打破</gydF4y2Baspan><span class="c1">#----------------------------------</gydF4y2Baspan><span class="c1">#向世界展示!</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">imshow</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">WINDOW_NAME</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">img_socket</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">waitKey</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">27</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">打破</gydF4y2Baspan><span class="c1">#用户按ESC退出</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getWindowProperty</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">WINDOW_NAME</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">WND_PROP_VISIBLE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">打破</gydF4y2Baspan><span class="c1">#用户关闭主窗口，退出</gydF4y2Baspan><span class="c1">#关闭预览和相机。确保调用cam_item。setParam（“开放”，1）before reusing a camera!</span><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">destroyAllWindows</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Cam2D_Close</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="p">）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="camera-calibration"> <h2><span class="section-number">6.31.</gydF4y2Baspan>摄像机标定<一个class="headerlink" href="#camera-calibration" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子展示了如何使用OpenCV找到一个相机的内在和外在属性。打印棋盘，并在移动棋盘时拍摄至少5张图像。你可以在这里找到更多信息<一个class="reference external" href="https://docs.opencv.org/master/dc/dbb/tutorial_py_calibration.html">OpenCV校准教程</一个>．</p><一个class="reference internal image-reference" href="https://raw.githubusercontent.com/opencv/opencv/master/doc/pattern.png"><img alt="https://raw.githubusercontent.com/opencv/opencv/master/doc/pattern.png＂class="align-center" src="https://raw.githubusercontent.com/opencv/opencv/master/doc/pattern.png" style="width: 60%;"></a> <div class="literal-block-wrapper docutils container" id="opencv-camera-calibration"> <div class="code-block-caption"> <span class="caption-text">OpenCV -摄像机校准</gydF4y2Baspan> <a class="headerlink" href="#opencv-camera-calibration" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">输入help("robolink")或help("robodk")查看更多信息</gydF4y2Baspan><span class="c1">#按F5运行脚本</gydF4y2Baspan><span class="c1">#文档://m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">#参考://m.sinclairbody.com/doc/en/PythonAPI/index.html</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">#使用棋盘和一系列图像找到相机的内在和外在属性。</gydF4y2Baspan><span class="c1">更多关于相机校准的细节:https://docs.opencv.org/master/dc/dbb/tutorial_py_calibration.html</gydF4y2Baspan><span class="c1">#你可以打印这个板的信件格式:https://github.com/opencv/opencv/blob/master/doc/pattern.png</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robodialogs</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">cv2</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="nn">简历</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">numpy</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="nn">np</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">一团</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#您可以为您的电路板编辑这些设置</gydF4y2Baspan><span class="n">SQUARES_X</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">10</gydF4y2Baspan><span class="c1">沿着X轴的方块数量</gydF4y2Baspan><span class="n">SQUARES_Y</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">7</gydF4y2Baspan><span class="c1">沿Y轴的方块数量</gydF4y2Baspan><span class="n">模式</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">SQUARES_X</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">SQUARES_Y</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">SQUARE_LENGTH</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mf">23.0</gydF4y2Baspan><span class="c1"># mm，一个正方形的长度</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#获取图片</gydF4y2Baspan><span class="n">images_dir</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">getSaveFolder</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">popup_msg</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“选择图片的目录”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">图片</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">一团</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">一团</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s1">/ * . png”</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">images_dir</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">一团</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">一团</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s1">/ * . jpg”</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">images_dir</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#解析图片</gydF4y2Baspan><span class="n">frame_size</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="n">obj_points</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［］</gydF4y2Baspan><span class="c1">#现实世界空间中的3D点</gydF4y2Baspan><span class="n">img_points</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［］</gydF4y2Baspan><span class="c1">图像平面上的# 2D点。</gydF4y2Baspan><span class="n">objp</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">0</gydF4y2Baspan><span class="p">（(</gydF4y2Baspan><span class="n">模式</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">模式</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">float32</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#对象点(0,0,0),(1,0,0),(2 0 0)……(8 5 0)</gydF4y2Baspan><span class="n">objp</gydF4y2Baspan><span class="p">(:,</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">mgrid</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">模式</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">模式</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">]]</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">T</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">重塑</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">SQUARE_LENGTH</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">图片</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#读取图像为灰度</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">imread</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">灰色的</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">cvtColor</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">COLOR_BGR2GRAY</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">frame_size</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">灰色的</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="p">(::</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1">#找到棋盘角</gydF4y2Baspan><span class="n">受潮湿腐烂</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">角落</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">findChessboardCorners</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">灰色的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">模式</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#如果发现，添加对象点，图像点(细化后)</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">受潮湿腐烂</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">rcorners</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">cornerSubPix</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">灰色的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">角落</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">11</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">11</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">TERM_CRITERIA_EPS</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">TERM_CRITERIA_MAX_ITER</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">30.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mf">0.001</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">img_points</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">rcorners</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">obj_points</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">objp</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#绘制并显示角</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">drawChessboardCorners</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">模式</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">rcorners</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">受潮湿腐烂</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">imshow</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">原始图像的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">waitKey</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">250</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">destroyAllWindows</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">获取校准后的相机参数</gydF4y2Baspan><span class="n">rms_err</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">calib_mtx</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">dist_coeffs</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">rvecs</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">tvecs</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">calibrateCamera</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">obj_points</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">img_points</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">frame_size</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">总体RMS重投影误差:</gydF4y2Baspan><span class="si">% 0.3度</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">rms_err</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#保存参数</gydF4y2Baspan><span class="n">文件</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">getSaveFileName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">strfile</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“RoboDK-Camera-Settings.yaml”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">defaultextension</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“.yaml”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">文件类型</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">((</gydF4y2Baspan><span class="s1">YAML文件的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“.yaml”</gydF4y2Baspan><span class="p">）］）</gydF4y2Baspan><span class="n">cv_file</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">FileStorage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">文件</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">FILE_STORAGE_WRITE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">cv_file</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">isOpened</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“未能保存校准文件”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cv_file</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">写</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“camera_matrix”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">calib_mtx</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cv_file</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">写</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“dist_coeff”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">dist_coeffs</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cv_file</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">写</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“camera_size”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">frame_size</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cv_file</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">释放</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="camera-pose"> <h2><span class="section-number">6.32.</gydF4y2Baspan>相机的姿势<一个class="headerlink" href="#camera-pose" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子展示了如何使用OpenCV估计相机的姿势。你需要一个校准的相机来估计相机的姿势，见前面的例子。你可以在<一个class="reference external" href="https://docs.opencv.org/master/df/d4a/tutorial_charuco_detection.html">OpenCV ChArUco教程</一个>．</p><一个class="reference internal image-reference" href="//m.sinclairbody.com/doc/en/PythonAPI/_images/CameraPose.png"><img alt="拍照姿势示例＂class="align-center" src="//m.sinclairbody.com/doc/en/PythonAPI/_images/CameraPose.png" style="width: 60%;"></a> <p>打印<一个class="reference external" href="https://docs.opencv.org/master/charucoboard.jpg">charucoboard</一个>以信件的形式放在相机前。</p><一个class="reference internal image-reference" href="//m.sinclairbody.com/doc/en/PythonAPI/_images/charucoboard.jpg"><img alt="https://docs.opencv.org/master/charucoboard.jpg＂class="align-center" src="//m.sinclairbody.com/doc/en/PythonAPI/_images/charucoboard.jpg" style="width: 60%;"></a> <div class="literal-block-wrapper docutils container" id="opencv-camera-pose"> <div class="code-block-caption"> <span class="caption-text">OpenCV -相机姿势</gydF4y2Baspan> <a class="headerlink" href="#opencv-camera-pose" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">输入help("robolink")或help("robodk")查看更多信息</gydF4y2Baspan><span class="c1">#按F5运行脚本</gydF4y2Baspan><span class="c1">#文档://m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">#参考://m.sinclairbody.com/doc/en/PythonAPI/index.html</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">使用OpenCV和ChArUco板估算一个相机姿势。</gydF4y2Baspan><span class="c1">更多关于ChArUco板的信息:https://docs.opencv.org/master/df/d4a/tutorial_charuco_detection.html</gydF4y2Baspan><span class="c1">#你可以打印这个板的信件格式:https://docs.opencv.org/master/charucoboard.jpg</gydF4y2Baspan><span class="c1">姿态估计需要相机校准，请参阅//m.sinclairbody.com/doc/en/PythonAPI/examples.html#camera-calibration</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robomath</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robodialogs</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">cv2</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="nn">简历</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">numpy</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="nn">np</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#如果您有多个设备，请相应地更改此选项</gydF4y2Baspan><span class="n">DEVICE_ID</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="c1">#您可以为您的电路板编辑这些设置</gydF4y2Baspan><span class="n">SQUARES_X</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">5</gydF4y2Baspan><span class="c1">沿着X轴的方块数量</gydF4y2Baspan><span class="n">SQUARES_Y</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">7</gydF4y2Baspan><span class="c1">沿Y轴的方块数量</gydF4y2Baspan><span class="n">SQUARE_LENGTH</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mf">35.0</gydF4y2Baspan><span class="c1"># mm，一个正方形的长度</gydF4y2Baspan><span class="n">MARKER_LENGTH</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mf">23.0</gydF4y2Baspan><span class="c1"># mm，一个标记的长度</gydF4y2Baspan><span class="n">DICTIONNARY</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">aruco</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getPredefinedDictionary</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">aruco</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">DICT_6X6_250</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#预定义的250个6x6位标记的字典</gydF4y2Baspan><span class="n">CHARUCOBOARD</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">aruco</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">CharucoBoard_create</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">SQUARES_X</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">SQUARES_Y</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">SQUARE_LENGTH</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">MARKER_LENGTH</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">DICTIONNARY</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#相机设置</gydF4y2Baspan><span class="n">CAMERA_WIDTH</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">1920</gydF4y2Baspan><span class="c1"># px</gydF4y2Baspan><span class="n">CAMERA_HEIGHT</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">1080</gydF4y2Baspan><span class="c1"># px</gydF4y2Baspan><span class="n">CAMERA_APERTURE</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mf">2．0</gydF4y2Baspan><span class="c1">#毫米</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#链接到RoboDK</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#拿起相机</gydF4y2Baspan><span class="n">捕获</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">VideoCapture</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">DEVICE_ID</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">捕获</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">isOpened</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ShowMessage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">"所选设备id [</gydF4y2Baspan><span class="si">{0}</gydF4y2Baspan><span class="s2">无法打开。确保相机已插入，并且没有其他应用程序正在使用它。”</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">格式</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">DEVICE_ID</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#设置相机分辨率。如果没有找到分辨率，它将默认为下一个可用分辨率。</gydF4y2Baspan><span class="n">捕获</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">集</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">CAP_PROP_FRAME_WIDTH</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">CAMERA_WIDTH</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">捕获</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">集</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">CAP_PROP_FRAME_HEIGHT</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">CAMERA_HEIGHT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">宽度</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">高度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">捕获</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">得到</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">CAP_PROP_FRAME_WIDTH</gydF4y2Baspan><span class="p">）），</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">捕获</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">得到</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">CAP_PROP_FRAME_HEIGHT</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“相机分辨率:</gydF4y2Baspan><span class="si">{0}</gydF4y2Baspan><span class="s1">，</gydF4y2Baspan><span class="si">{1}</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">格式</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">宽度</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">高度</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#获取相机校准参数</gydF4y2Baspan><span class="c1">#见//m.sinclairbody.com/doc/en/PythonAPI/examples.html#camera-calibration</gydF4y2Baspan><span class="n">文件</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">getOpenFileName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">strfile</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“RoboDK-Camera-Settings.yaml”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">strtitle</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">打开校准设置文件。</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">defaultextension</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“.yaml”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">文件类型</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">((</gydF4y2Baspan><span class="s1">YAML文件的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“.yaml”</gydF4y2Baspan><span class="p">）］）</gydF4y2Baspan><span class="n">cv_file</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">FileStorage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">文件</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">FILE_STORAGE_READ</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">cv_file</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">isOpened</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ShowMessage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“处理校准文件失败”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">CAMERA_MTX</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">cv_file</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getNode</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“camera_matrix”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">垫</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">DIST_COEFFS</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">cv_file</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getNode</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“dist_coeff”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">垫</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">CALIB_SIZE</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">cv_file</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getNode</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“camera_size”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">垫</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">astype</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cv_file</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">释放</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#如果校准的相机分辨率和当前分辨率不同，近似相机矩阵</gydF4y2Baspan><span class="n">c_width</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">c_height</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">CALIB_SIZE</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">宽度</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">高度</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">c_width</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">c_height</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ShowMessage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">校准分辨率和当前分辨率不同。将使用近似校准矩阵。”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">w_ratio</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">宽度</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="n">c_width</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1"># (dimx' / dimx)</gydF4y2Baspan><span class="n">h_ratio</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">高度</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="n">c_height</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1"># (dimy' / dimy)</gydF4y2Baspan><span class="n">CAMERA_MTX</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">w_ratio</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">CAMERA_MTX</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1"># fx' = (dimx' / dimx) * fx</gydF4y2Baspan><span class="n">CAMERA_MTX</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">h_ratio</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">CAMERA_MTX</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1"># fy' = (dimy' / dimy) * fy</gydF4y2Baspan><span class="n">CAMERA_MTX</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">w_ratio</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">CAMERA_MTX</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1"># cx' = (dimx' / dimx) * cx</gydF4y2Baspan><span class="n">CAMERA_MTX</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">h_ratio</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">CAMERA_MTX</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1"># cy' = (dimy' / dimy) * cy</gydF4y2Baspan><span class="c1">假设光圈为2毫米，如果需要更新</gydF4y2Baspan><span class="n">fovx</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">fovy</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">focal_length</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">p_point</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">比</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">calibrationMatrixValues</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">CAMERA_MTX</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">宽度</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">高度</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="n">CAMERA_APERTURE</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">CAMERA_APERTURE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#关闭相机窗口，如果有的话</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Cam2D_Close</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#为姿态估计创建charuco框架</gydF4y2Baspan><span class="n">board_frame_name</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“ChArUco框架”</gydF4y2Baspan><span class="n">board_ref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">board_frame_name</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_FRAME</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">board_ref</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">board_ref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">board_frame_name</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#创建一个附加相机的框架</gydF4y2Baspan><span class="n">cam_frame_name</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“相机帧”</gydF4y2Baspan><span class="n">cam_ref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">cam_frame_name</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_FRAME</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">cam_ref</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">cam_ref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">cam_frame_name</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cam_ref</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParent</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">board_ref</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#模拟摄像头</gydF4y2Baspan><span class="n">cam_name</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“相机”</gydF4y2Baspan><span class="n">cam_id</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">cam_name</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_CAMERA</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">cam_id</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">cam_id</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">删除</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#重复使用同一个相机不能正确应用设置</gydF4y2Baspan><span class="n">camera_settings</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">' FOCAL_LENGTH =</gydF4y2Baspan><span class="si">{0:0.0f}</gydF4y2Baspan><span class="s1">FOV =</gydF4y2Baspan><span class="si">{1:0.0f}</gydF4y2Baspan><span class="s1">快照=</gydF4y2Baspan><span class="si">{2:0.0f}</gydF4y2Baspan><span class="s1">x</gydF4y2Baspan><span class="si">{3:0.0f}</gydF4y2Baspan><span class="s1">大小=</gydF4y2Baspan><span class="si">{2:0.0f}</gydF4y2Baspan><span class="s1">x</gydF4y2Baspan><span class="si">{3:0.0f}</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">格式</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">focal_length</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">fovy</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">宽度</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">高度</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cam_id</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Cam2D_Add</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">cam_ref</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">camera_settings</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cam_id</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">cam_name</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cam_id</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParent</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">cam_ref</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#创建输出窗口</gydF4y2Baspan><span class="n">preview_window</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“相机窗口”</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">namedWindow</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">preview_window</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">WINDOW_KEEPRATIO</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">resizeWindow</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">preview_window</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">宽度</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">高度</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#找到拍照姿势</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="n">捕获</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">isOpened</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="c1">#从相机中获取图像</gydF4y2Baspan><span class="n">成功</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">捕获</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">读</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">成功</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">继续</gydF4y2Baspan><span class="c1">#找到黑板标记</gydF4y2Baspan><span class="n">mcorners</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">mids</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">＿</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">aruco</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">detectMarkers</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">DICTIONNARY</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">CAMERA_MTX</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">DIST_COEFFS</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">mids</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="ow">而且</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">mids</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">></gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">从标记中插入charuco角</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">角落</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">id</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">aruco</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">interpolateCornersCharuco</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">mcorners</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">mids</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">CHARUCOBOARD</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">CAMERA_MTX</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">DIST_COEFFS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">></gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="ow">而且</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">id</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">></gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“检测到角落:</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">id:</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">角落</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">id</gydF4y2Baspan><span class="p">）））</gydF4y2Baspan><span class="c1">在图像上绘制角</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">aruco</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">drawDetectedCornersCharuco</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">角落</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">id</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#估计charuco板的姿势</gydF4y2Baspan><span class="n">成功</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">rvec</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">tvec</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">aruco</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">estimatePoseCharucoBoard</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">角落</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">id</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">CHARUCOBOARD</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">CAMERA_MTX</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">DIST_COEFFS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">成功</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">在图像上绘制轴</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">aruco</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">drawAxis</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">CAMERA_MTX</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">DIST_COEFFS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">rvec</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">tvec</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mf">One hundred.</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#你可以过滤多少标记需要找到，以更新姿态如下</gydF4y2Baspan><span class="n">board_size</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">CHARUCOBOARD</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getChessboardSize</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">min_corners</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（(</gydF4y2Baspan><span class="n">board_size</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">board_size</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="mf">0．5</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#占总数的%</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">角落</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">> =</gydF4y2Baspan><span class="n">min_corners</gydF4y2Baspan><span class="ow">而且</gydF4y2Baspan><span class="n">id</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">大小</gydF4y2Baspan><span class="o">> =</gydF4y2Baspan><span class="n">min_corners</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#找到拍照姿势</gydF4y2Baspan><span class="n">rmat</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">罗德里格斯</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">rvec</gydF4y2Baspan><span class="p">) [</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">camera_position</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">矩阵</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">rmat</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">T</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">矩阵</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">tvec</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cam_xyz</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">camera_position</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">T</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">tolist</gydF4y2Baspan><span class="p">() (</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">vx</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">v</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">vz</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">rmat</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">tolist</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#为RoboDK建立相机姿势</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">眼睛</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPos</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">cam_xyz</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setVX</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">vx</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setVY</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">v</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setVZ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">vz</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#更新RoboDK中的姿势</gydF4y2Baspan><span class="n">cam_ref</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#展示charuco板</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">imshow</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">preview_window</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">waitKey</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">27</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">打破</gydF4y2Baspan><span class="c1">#用户按ESC退出</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getWindowProperty</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">preview_window</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">WND_PROP_VISIBLE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">打破</gydF4y2Baspan><span class="c1">#用户关闭主窗口，退出</gydF4y2Baspan><span class="c1">#释放设备</gydF4y2Baspan><span class="n">捕获</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">释放</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">destroyAllWindows</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="augmented-reality"> <h2><span class="section-number">6.33.</gydF4y2Baspan>增强现实<一个class="headerlink" href="#augmented-reality" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子展示了如何使用OpenCV将RoboDK的增强现实应用到输入摄像机馈电上。你需要一个校准的相机来估计相机的姿势，见前面的例子。</p><一个class="reference internal image-reference" href="//m.sinclairbody.com/doc/en/PythonAPI/_images/AugReality.png"><img alt="增强现实＂class="align-center" src="//m.sinclairbody.com/doc/en/PythonAPI/_images/AugReality.png" style="width: 60%;"></a> <div class="literal-block-wrapper docutils container" id="opencv-augmented-reality"> <div class="code-block-caption"> <span class="caption-text">OpenCV -增强现实</gydF4y2Baspan> <a class="headerlink" href="#opencv-augmented-reality" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">输入help("robolink")或help("robodk")查看更多信息</gydF4y2Baspan><span class="c1">#按F5运行脚本</gydF4y2Baspan><span class="c1">#文档://m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">#参考://m.sinclairbody.com/doc/en/PythonAPI/index.html</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">#使用OpenCV和ChArUco板应用增强现实。</gydF4y2Baspan><span class="c1">更多关于ChArUco板的信息:https://docs.opencv.org/master/df/d4a/tutorial_charuco_detection.html</gydF4y2Baspan><span class="c1">#你可以打印这个板的信件格式:https://docs.opencv.org/master/charucoboard.jpg</gydF4y2Baspan><span class="c1">姿态估计需要相机校准，请参阅//m.sinclairbody.com/doc/en/PythonAPI/examples.html#camera-calibration</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robomath</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robodialogs</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">cv2</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="nn">简历</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">numpy</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="nn">np</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#如果您有多个设备，请相应地更改此选项</gydF4y2Baspan><span class="n">DEVICE_ID</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="c1">#您可以为您的电路板编辑这些设置</gydF4y2Baspan><span class="n">SQUARES_X</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">5</gydF4y2Baspan><span class="c1">沿着X轴的方块数量</gydF4y2Baspan><span class="n">SQUARES_Y</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">7</gydF4y2Baspan><span class="c1">沿Y轴的方块数量</gydF4y2Baspan><span class="n">SQUARE_LENGTH</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mf">35.0</gydF4y2Baspan><span class="c1"># mm，一个正方形的长度</gydF4y2Baspan><span class="n">MARKER_LENGTH</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mf">23.0</gydF4y2Baspan><span class="c1"># mm，一个标记的长度</gydF4y2Baspan><span class="n">规模</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">#如果你不希望有1:1的比例，你可能想要编辑这个。</gydF4y2Baspan><span class="n">DICTIONNARY</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">aruco</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getPredefinedDictionary</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">aruco</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">DICT_6X6_250</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#预定义的250个6x6位标记的字典</gydF4y2Baspan><span class="n">CHARUCOBOARD</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">aruco</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">CharucoBoard_create</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">SQUARES_X</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">SQUARES_Y</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">SQUARE_LENGTH</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="n">规模</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">MARKER_LENGTH</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="n">规模</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">DICTIONNARY</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#相机设置</gydF4y2Baspan><span class="n">CAMERA_WIDTH</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">1920</gydF4y2Baspan><span class="c1"># px</gydF4y2Baspan><span class="n">CAMERA_HEIGHT</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">1080</gydF4y2Baspan><span class="c1"># px</gydF4y2Baspan><span class="n">CAMERA_APERTURE</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mf">2．0</gydF4y2Baspan><span class="c1">#毫米</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">将RoboDK图像与输入图像合并的实用函数</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">merge_img</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img_bg</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">img_fg</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="c1">AR图像的掩模和反掩模</gydF4y2Baspan><span class="n">＿</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">面具</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">阈值</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">cvtColor</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img_fg</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">COLOR_BGR2GRAY</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">10</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">255</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">THRESH_BINARY</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">mask_inv</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">bitwise_not</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">面具</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#从环境图像中屏蔽AR区域</gydF4y2Baspan><span class="n">img1_bg</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">bitwise_and</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img_bg</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">img_bg</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">面具</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">mask_inv</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#从AR图像中取出AR区域</gydF4y2Baspan><span class="n">img2_fg</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">bitwise_and</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img_fg</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">img_fg</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">面具</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">面具</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#合并</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">添加</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img1_bg</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">img2_fg</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#链接到RoboDK</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#拿起相机</gydF4y2Baspan><span class="n">捕获</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">VideoCapture</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">DEVICE_ID</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">捕获</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">isOpened</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ShowMessage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">"所选设备id [</gydF4y2Baspan><span class="si">{0}</gydF4y2Baspan><span class="s2">无法打开。确保相机已插入，并且没有其他应用程序正在使用它。”</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">格式</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">DEVICE_ID</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#设置相机分辨率。如果没有找到分辨率，它将默认为下一个可用分辨率。</gydF4y2Baspan><span class="n">捕获</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">集</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">CAP_PROP_FRAME_WIDTH</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">CAMERA_WIDTH</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">捕获</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">集</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">CAP_PROP_FRAME_HEIGHT</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">CAMERA_HEIGHT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">宽度</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">高度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">捕获</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">得到</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">CAP_PROP_FRAME_WIDTH</gydF4y2Baspan><span class="p">）），</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">捕获</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">得到</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">CAP_PROP_FRAME_HEIGHT</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“相机分辨率:</gydF4y2Baspan><span class="si">{0}</gydF4y2Baspan><span class="s1">，</gydF4y2Baspan><span class="si">{1}</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">格式</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">宽度</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">高度</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#获取相机校准参数</gydF4y2Baspan><span class="n">文件</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">getOpenFileName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">strfile</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“RoboDK-Camera-Settings.yaml”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">strtitle</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">打开校准设置文件。</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">defaultextension</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“.yaml”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">文件类型</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">((</gydF4y2Baspan><span class="s1">YAML文件的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“.yaml”</gydF4y2Baspan><span class="p">）］）</gydF4y2Baspan><span class="n">cv_file</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">FileStorage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">文件</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">FILE_STORAGE_READ</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">cv_file</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">isOpened</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ShowMessage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“处理校准文件失败”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">CAMERA_MTX</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">cv_file</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getNode</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“camera_matrix”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">垫</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">DIST_COEFFS</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">cv_file</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getNode</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“dist_coeff”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">垫</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">CALIB_SIZE</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">cv_file</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getNode</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“camera_size”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">垫</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">astype</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cv_file</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">释放</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#如果校准的相机分辨率和当前分辨率不同，近似相机矩阵</gydF4y2Baspan><span class="n">c_width</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">c_height</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">CALIB_SIZE</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">宽度</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">高度</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">c_width</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">c_height</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ShowMessage</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">校准分辨率和当前分辨率不同。将使用近似校准矩阵。”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">CAMERA_MTX</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">宽度</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="n">c_width</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">CAMERA_MTX</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1"># fx' = (dimx' / dimx) * fx</gydF4y2Baspan><span class="n">CAMERA_MTX</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">高度</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="n">c_height</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">CAMERA_MTX</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1"># fy' = (dimy' / dimy) * fy</gydF4y2Baspan><span class="c1">假设光圈为2毫米，如果需要更新</gydF4y2Baspan><span class="n">fovx</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">fovy</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">focal_length</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">p_point</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">比</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">calibrationMatrixValues</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">CAMERA_MTX</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">宽度</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">高度</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="n">CAMERA_APERTURE</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">CAMERA_APERTURE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#关闭相机窗口，如果有的话</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Cam2D_Close</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#为姿态估计创建charuco框架</gydF4y2Baspan><span class="n">board_frame_name</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“ChArUco框架”</gydF4y2Baspan><span class="n">board_ref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">board_frame_name</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_FRAME</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">board_ref</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">board_ref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">board_frame_name</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#创建一个附加相机的框架</gydF4y2Baspan><span class="n">cam_frame_name</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“相机帧”</gydF4y2Baspan><span class="n">cam_ref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">cam_frame_name</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_FRAME</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">cam_ref</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">cam_ref</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">cam_frame_name</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cam_ref</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParent</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">board_ref</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#模拟摄像头</gydF4y2Baspan><span class="n">cam_name</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“相机”</gydF4y2Baspan><span class="n">cam_id</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">cam_name</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_CAMERA</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">cam_id</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">cam_id</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">删除</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#重复使用同一个相机不能正确应用设置</gydF4y2Baspan><span class="n">camera_settings</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">' FOCAL_LENGTH =</gydF4y2Baspan><span class="si">{0:0.0f}</gydF4y2Baspan><span class="s1">FOV =</gydF4y2Baspan><span class="si">{1:0.0f}</gydF4y2Baspan><span class="s1">BG_COLOR=黑色FAR_LENGTH=5000快照=</gydF4y2Baspan><span class="si">{2:0.0f}</gydF4y2Baspan><span class="s1">x</gydF4y2Baspan><span class="si">{3:0.0f}</gydF4y2Baspan><span class="s1">大小=</gydF4y2Baspan><span class="si">{2:0.0f}</gydF4y2Baspan><span class="s1">x</gydF4y2Baspan><span class="si">{3:0.0f}</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">格式</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">focal_length</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">fovy</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">宽度</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">高度</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cam_id</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Cam2D_Add</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">cam_ref</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">camera_settings</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cam_id</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">cam_name</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cam_id</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParent</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">cam_ref</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">父</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="c1">#创建输出窗口</gydF4y2Baspan><span class="n">preview_window</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“相机窗口”</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">namedWindow</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">preview_window</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">WINDOW_KEEPRATIO</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">resizeWindow</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">preview_window</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">宽度</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">高度</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#找到拍照姿势</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="n">捕获</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">isOpened</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="c1">#从相机中获取图像</gydF4y2Baspan><span class="n">成功</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">捕获</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">读</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">成功</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">继续</gydF4y2Baspan><span class="c1">#找到黑板标记</gydF4y2Baspan><span class="n">mcorners</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">mids</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">＿</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">aruco</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">detectMarkers</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">DICTIONNARY</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">CAMERA_MTX</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">DIST_COEFFS</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">mids</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="ow">而且</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">mids</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">></gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">从标记中插入charuco角</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">角落</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">id</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">aruco</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">interpolateCornersCharuco</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">mcorners</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">mids</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">CHARUCOBOARD</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">CAMERA_MTX</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">DIST_COEFFS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">></gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="ow">而且</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">id</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">></gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“检测到角落:</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">id:</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">角落</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">id</gydF4y2Baspan><span class="p">）））</gydF4y2Baspan><span class="c1">在图像上绘制角</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">aruco</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">drawDetectedCornersCharuco</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">角落</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">id</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#估计charuco板的姿势</gydF4y2Baspan><span class="n">成功</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">rvec</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">tvec</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">aruco</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">estimatePoseCharucoBoard</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">角落</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">id</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">CHARUCOBOARD</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">CAMERA_MTX</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">DIST_COEFFS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">成功</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">在图像上绘制轴</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">aruco</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">drawAxis</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">CAMERA_MTX</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">DIST_COEFFS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">rvec</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">tvec</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mf">One hundred.</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#你可以过滤多少标记需要找到，以更新姿态如下</gydF4y2Baspan><span class="n">board_size</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">CHARUCOBOARD</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getChessboardSize</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">min_corners</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（(</gydF4y2Baspan><span class="n">board_size</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">board_size</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="mf">0.8</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#占总数的%</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">角落</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">> =</gydF4y2Baspan><span class="n">min_corners</gydF4y2Baspan><span class="ow">而且</gydF4y2Baspan><span class="n">id</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">大小</gydF4y2Baspan><span class="o">> =</gydF4y2Baspan><span class="n">min_corners</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#找到拍照姿势</gydF4y2Baspan><span class="n">rmat</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">罗德里格斯</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">rvec</gydF4y2Baspan><span class="p">) [</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">camera_position</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">矩阵</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">rmat</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">T</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">矩阵</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">tvec</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cam_xyz</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">camera_position</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">T</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">tolist</gydF4y2Baspan><span class="p">() (</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">vx</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">v</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">vz</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">rmat</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">tolist</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#为RoboDK建立相机姿势</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">眼睛</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPos</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">cam_xyz</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setVX</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">vx</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setVY</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">v</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setVZ</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">vz</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#更新RoboDK中的姿势</gydF4y2Baspan><span class="n">cam_ref</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#获取RDK相机图像</gydF4y2Baspan><span class="n">image_rdk</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="n">bytes_img</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Cam2D_Snapshot</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">＂＂</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">cam_id</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">nparr</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">frombuffer</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">bytes_img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">uint8</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">image_rdk</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">imdecode</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">nparr</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">IMREAD_COLOR</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#应用AR</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">merge_img</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">image_rdk</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#展示charuco板</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">imshow</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">preview_window</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">waitKey</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">27</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">打破</gydF4y2Baspan><span class="c1">#用户按ESC退出</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getWindowProperty</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">preview_window</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">WND_PROP_VISIBLE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">打破</gydF4y2Baspan><span class="c1">#用户关闭主窗口，退出</gydF4y2Baspan><span class="c1">#释放设备</gydF4y2Baspan><span class="n">捕获</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">释放</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">destroyAllWindows</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="qr-codes-and-barcodes"> <h2><span class="section-number">6.34.</gydF4y2Baspan>二维码和条形码<一个class="headerlink" href="#qr-codes-and-barcodes" title="¶＂>gydF4y2Ba¶</一个></h2><p>这个例子展示了如何从RoboDK的输入摄像头读取QR码和条形码(EAN-13, UPC-A等)。输入摄像头可以是物理设备，也可以是RoboDK的模拟摄像头。它还提供实用程序脚本，将QR码和条形码作为对象添加到RoboDK站。</p><p>gydF4y2Ba检测到的二维码和条形码将显示在单独的视图窗口中，检测用红色高亮显示。检测后，可以要求机器人根据读数将物品放置在特定的输送带、料仓等上。</p><一个class="reference internal image-reference" href="//m.sinclairbody.com/doc/en/PythonAPI/_images/QRBarcodeReader.png"><img alt="_images / QRBarcodeReader.png＂class="align-center" src="//m.sinclairbody.com/doc/en/PythonAPI/_images/QRBarcodeReader.png" style="width: 60%;"></a> <div class="section" id="generating-qr-codes"> <h3><span class="section-number">6.34.1.</gydF4y2Baspan>生成二维码<一个class="headerlink" href="#generating-qr-codes" title="¶＂>gydF4y2Ba¶</一个></h3.><div class="literal-block-wrapper docutils container" id="qr-codes-generator"> <div class="code-block-caption"> <span class="caption-text">二维码-生成器</gydF4y2Baspan> <a class="headerlink" href="#qr-codes-generator" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">输入help("robolink")或help("robodk")查看更多信息</gydF4y2Baspan><span class="c1">#按F5运行脚本</gydF4y2Baspan><span class="c1">#文档://m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">#参考://m.sinclairbody.com/doc/en/PythonAPI/index.html</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">这个脚本允许您创建一个包含QR码的RoboDK对象。</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># RoboDK API</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robodialogs</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">import_install</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“qrcode”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">qrcode</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#设置</gydF4y2Baspan><span class="n">ASK_USER_SAVE_TO_DISK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="c1"># True要求用户保存到磁盘。否则，使用临时文件夹并添加到RoboDK。</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#创建二维码</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">mbox</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“输入文本，嵌入您的二维码”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">条目</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s2">“m.sinclairbody.com”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="nb">类型</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="nb">str</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#用户取消</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">qrcode</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">使</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#保存到文件</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s2">“QR_”</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">取代</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“。”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">取代</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“:”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">取代</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">' / '</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1"># //m.sinclairbody.com/doc/en/PythonAPI/index.html</gydF4y2Baspan><span class="n">文件名</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">ASK_USER_SAVE_TO_DISK</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">文件名</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">getSaveFileName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">strtitle</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“将QR保存在磁盘上，或取消以跳过”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">strfile</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">defaultextension</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“使用”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">文件类型</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">((</gydF4y2Baspan><span class="s1">PNG文件的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">‘* . png”</gydF4y2Baspan><span class="p">）］）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">文件名</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">文件名</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="s1">”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">tempfile</gydF4y2Baspan><span class="n">tempdir</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">tempfile</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">gettempdir</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">文件名</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">tempdir</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="se">\ \</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s2">“使用”</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">保存</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">文件名</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">os.path</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">操作系统</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">路径</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">存在</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">文件名</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">在RoboDK中导入</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">img_item</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddFile</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">文件名</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">img_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="generating-barcodes-ean-13"> <h3><span class="section-number">6.34.2.</gydF4y2Baspan>生成条形码(EAN-13)<一个class="headerlink" href="#generating-barcodes-ean-13" title="¶＂>gydF4y2Ba¶</一个></h3.><div class="literal-block-wrapper docutils container" id="barcode-ean-13-generator"> <div class="code-block-caption"> <span class="caption-text">条形码(EAN-13) -生成器</gydF4y2Baspan> <a class="headerlink" href="#barcode-ean-13-generator" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">输入help("robolink")或help("robodk")查看更多信息</gydF4y2Baspan><span class="c1">#按F5运行脚本</gydF4y2Baspan><span class="c1">#文档://m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">#参考://m.sinclairbody.com/doc/en/PythonAPI/index.html</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">#这个脚本允许你创建一个包含EAN13条形码(欧洲)的RoboDK对象。</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># RoboDK API</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robodialogs</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">import_install</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“条形码”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“python-barcode”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">条形码</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#设置</gydF4y2Baspan><span class="n">ASK_USER_SAVE_TO_DISK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="c1"># True要求用户保存到磁盘。否则，使用临时文件夹并添加到RoboDK。</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#创建条形码</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">mbox</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">"输入条码(EAN 13位)"</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">条目</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“5701234567899”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="nb">类型</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="nb">str</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#用户取消</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">isdecimal</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="mi">13</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#无效输入</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">条形码</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">EAN13</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">作家</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">条形码</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">作家</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">图像打印机</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="c1">#您可以轻松复制此脚本以生成其他条形码类型，如UPC-A</gydF4y2Baspan><span class="c1">#img =条形码。UPCA(数据、作家= barcode.writer.ImageWriter ())</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#保存到文件</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s2">“EAN13_”</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">数据</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">取代</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“。”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">取代</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“:”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">取代</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">' / '</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">文件名</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">ASK_USER_SAVE_TO_DISK</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">文件名</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">getSaveFileName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">strtitle</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“将条形码保存在磁盘上，或取消以跳过”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">strfile</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">defaultextension</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“使用”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">文件类型</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">((</gydF4y2Baspan><span class="s1">PNG文件的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">‘* . png”</gydF4y2Baspan><span class="p">）］）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">文件名</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">文件名</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="s1">”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">tempfile</gydF4y2Baspan><span class="n">tempdir</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">tempfile</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">gettempdir</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">文件名</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">tempdir</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="se">\ \</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">保存</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">文件名</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">文件名</gydF4y2Baspan><span class="o">+ =</gydF4y2Baspan><span class="s1">“使用”</gydF4y2Baspan><span class="c1"># barcode .save添加。png格式</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">os.path</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">操作系统</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">路径</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">存在</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">文件名</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">在RoboDK中导入</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">img_item</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddFile</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">文件名</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">img_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="reading-qr-codes-and-bar-codes"> <h3><span class="section-number">6.34.3.</gydF4y2Baspan>阅读二维码和条形码<一个class="headerlink" href="#reading-qr-codes-and-bar-codes" title="¶＂>gydF4y2Ba¶</一个></h3.><div class="literal-block-wrapper docutils container" id="qr-and-barcode-reader"> <div class="code-block-caption"> <span class="caption-text">QR和条形码阅读器</gydF4y2Baspan> <a class="headerlink" href="#qr-and-barcode-reader" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">输入help("robolink")或help("robodk")查看更多信息</gydF4y2Baspan><span class="c1">#按F5运行脚本</gydF4y2Baspan><span class="c1">#文档://m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">#参考://m.sinclairbody.com/doc/en/PythonAPI/index.html</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">这个脚本处理一个相机帧来提取QR和条形码。</gydF4y2Baspan><span class="c1">#它目前使用RoboDK相机，但它可以很容易地适应使用物理设备。</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># RoboDK API</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robomath</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">#机器人工具箱</gydF4y2Baspan><span class="n">import_install</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“cv2”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s2">“opencv-contrib-python”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1"># contrib版本添加了条形码支持</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">cv2</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="nn">简历</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">tempfile</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#设置</gydF4y2Baspan><span class="n">PROCESS_COUNT</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">#退出前要处理多少帧。-1表示无限。</gydF4y2Baspan><span class="n">DETECT_COLOR</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">255</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#开始摄像。</gydF4y2Baspan><span class="c1">#如果您使用的是联网设备，请使用cv。视频捕捉来获得现场直播。</gydF4y2Baspan><span class="c1"># https://docs.opencv.org/master/d8/dfe/classcv_1_1VideoCapture.html</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1"># capture = cv.VideoCapture(0)</gydF4y2Baspan><span class="c1"># retval, image = capture.read()</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#从RoboDK那里获取相机</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemUserPick</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“选择相机”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_CAMERA</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">辞职</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#初始化QR和条形码探测器</gydF4y2Baspan><span class="n">qr_detector</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">QRCodeDetector</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1"># https://docs.opencv.org/master/de/dc3/classcv_1_1QRCodeDetector.html</gydF4y2Baspan><span class="n">barcode_detector</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">barcode_BarcodeDetector</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1"># https://docs.opencv.org/master/d2/dea/group__barcode.html</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#现在，我们需要在磁盘上保存RDK快照。</gydF4y2Baspan><span class="c1">#一个新的更新即将到来，它将返回图像，如:img = RDK。Cam2D_Snapshot (cam_item”)</gydF4y2Baspan><span class="n">tempdir</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">tempfile</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">gettempdir</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">snapshot_file</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">tempdir</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="se">\ \</gydF4y2Baspan><span class="s2">code_reader_temp.png”</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#处理相机帧</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="n">PROCESS_COUNT</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">PROCESS_COUNT</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">+ =</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#保存并从RoboDK获取图像</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Cam2D_Snapshot</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">snapshot_file</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">imread</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">snapshot_file</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#检查二维码</gydF4y2Baspan><span class="n">retval</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">decoded_info_list</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">points_list</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">straight_qrcode_list</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">qr_detector</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">detectAndDecodeMulti</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">retval</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">points_list</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">points_list</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">astype</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">n_qr</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">decoded_info_list</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">n_qr</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“发现二维码:”</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">decoded_info_list</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="c1">绘制轮廓线</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">points_list</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">n_lines</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">j</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">n_lines</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">point1</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">j</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">卷帘窗</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">((</gydF4y2Baspan><span class="n">j</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">n_lines</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">point1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">卷帘窗</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">颜色</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">DETECT_COLOR</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">厚度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#打印二维码内容</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">putText</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">decoded_info_list</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">FONT_HERSHEY_SIMPLEX</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">DETECT_COLOR</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">LINE_AA</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#检查条形码</gydF4y2Baspan><span class="n">retval</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">decoded_info_list</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">decoded_type_list</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">points_list</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">barcode_detector</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">detectAndDecode</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">retval</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">points_list</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">points_list</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">astype</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">n_bar</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">decoded_info_list</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">n_bar</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">barcodeType</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">decoded_type</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">-></gydF4y2Baspan><span class="nb">str</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">decoded_type</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">条形码</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">EAN_8</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="s2">“EAN8”</gydF4y2Baspan><span class="k">elif</gydF4y2Baspan><span class="n">decoded_type</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">条形码</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">EAN_13</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="s2">“EAN13”</gydF4y2Baspan><span class="k">elif</gydF4y2Baspan><span class="n">decoded_type</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">条形码</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">UPC_A</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="s2">“UPC-A”</gydF4y2Baspan><span class="k">elif</gydF4y2Baspan><span class="n">decoded_type</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">条形码</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">UPC_E</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="s2">“UPC-E”</gydF4y2Baspan><span class="k">elif</gydF4y2Baspan><span class="n">decoded_type</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">条形码</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">UPC_EAN_EXTENSION</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="s2">“UPC-EAN”</gydF4y2Baspan><span class="k">其他的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="s2">“没有”</gydF4y2Baspan><span class="n">barcode_type</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">barcodeType</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">decoded_type_list</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“找到的条形码:”</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">decoded_info_list</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s2">”,(</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s2">)”</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">barcode_type</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">绘制轮廓线</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">points_list</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">n_lines</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">j</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">n_lines</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">point1</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">j</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">卷帘窗</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">((</gydF4y2Baspan><span class="n">j</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">n_lines</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">point1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">卷帘窗</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">颜色</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">DETECT_COLOR</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">厚度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#打印条形码内容</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">putText</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">decoded_info_list</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">FONT_HERSHEY_SIMPLEX</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">DETECT_COLOR</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">LINE_AA</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#显示在屏幕上</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">imshow</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“二维码阅读器”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">waitKey</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#现在，您可以处理项目了。</gydF4y2Baspan><span class="c1">#例如，要求机器人将物品放在特定的传送带、箱子等上。</gydF4y2Baspan><span class="n">暂停</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">destroyAllWindows</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan></pre> </div> </div> </div> </div> </div> <div class="section" id="object-detection"> <h2><span class="section-number">6.35.</gydF4y2Baspan>对象检测<一个class="headerlink" href="#object-detection" title="¶＂>gydF4y2Ba¶</一个></h2><div class="section" id="d-pose-estimation-of-a-known-object"> <h3><span class="section-number">6.35.1.</gydF4y2Baspan>已知物体的二维姿态估计<一个class="headerlink" href="#d-pose-estimation-of-a-known-object" title="¶＂>gydF4y2Ba¶</一个></h3.><p>这个例子展示了如何使用OpenCV将输入图像(源对象)与相机馈电匹配以确定它的2D姿态。它使用模拟摄像头，但可以很容易地修改为使用输入摄像头。这只计算沿Z轴的旋转和X/Y偏移。它不是用于3D定位的。你可以在<一个class="reference external" href="https://docs.opencv.org/master/d7/dff/tutorial_feature_homography.html">OpenCV单应图教程</一个>．</p><一个class="reference internal image-reference" href="//m.sinclairbody.com/doc/en/PythonAPI/_images/SIFT.png"><img alt="_images / SIFT.png＂class="align-center" src="//m.sinclairbody.com/doc/en/PythonAPI/_images/SIFT.png" style="width: 60%;"></a> <div class="literal-block-wrapper docutils container" id="id9"> <div class="code-block-caption"> <span class="caption-text">已知物体的二维姿态估计</gydF4y2Baspan> <a class="headerlink" href="#id9" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">输入help("robolink")或help("robodk")查看更多信息</gydF4y2Baspan><span class="c1">#按F5运行脚本</gydF4y2Baspan><span class="c1">#文档://m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">#参考://m.sinclairbody.com/doc/en/PythonAPI/index.html</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">这个例子展示了如何使用SIFT算法匹配输入图像(源对象)与相机反馈以确定它的2D姿态。</gydF4y2Baspan><span class="c1">#它使用模拟摄像头，但它可以很容易地修改为使用输入摄像头。</gydF4y2Baspan><span class="c1">#警告:这只计算沿Z轴的旋转，以及X/Y偏移量。它不是用于3D定位的。</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">你可以在OpenCV单应图教程中找到更多信息:</gydF4y2Baspan><span class="c1"># https://docs.opencv.org/master/d7/dff/tutorial_feature_homography.html</gydF4y2Baspan><span class="c1"># https://docs.opencv.org/master/d9/dab/tutorial_homography.html</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># RoboDK API</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robomath</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">#机器人工具箱</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robodialogs</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">import_install</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“cv2”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“opencv-contrib-python”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">cv2</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="nn">简历</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">numpy</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="nn">np</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">tempfile</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">数学</gydF4y2Baspan><span class="c1">#----------------------------------</gydF4y2Baspan><span class="c1">#设置</gydF4y2Baspan><span class="n">PROCESS_COUNT</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">#退出前要处理多少帧。-1表示无限。</gydF4y2Baspan><span class="c1">#相机</gydF4y2Baspan><span class="n">CAM_NAME</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s2">“相机”</gydF4y2Baspan><span class="n">CAMERA_SIZE_X</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mf">1280.0</gydF4y2Baspan><span class="c1">#像素</gydF4y2Baspan><span class="n">CAMERA_SIZE_Y</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mf">720.0</gydF4y2Baspan><span class="c1">#像素</gydF4y2Baspan><span class="n">PIXEL_SIZE_X</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mf">100.0</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mf">175.0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1"># mm/像素，实验发现</gydF4y2Baspan><span class="n">PIXEL_SIZE_Y</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mf">100.0</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mf">175.0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1"># mm /像素</gydF4y2Baspan><span class="n">Z_OFFSET</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mf">715.0</gydF4y2Baspan><span class="c1"># mm，相机和零件表面之间的距离</gydF4y2Baspan><span class="c1">#计算框架和目标</gydF4y2Baspan><span class="n">OBJ_NAME</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s2">“RoboDK盒子”</gydF4y2Baspan><span class="n">CALC_FRAME_NAME</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s2">Calc框架”</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">OBJ_NAME</gydF4y2Baspan><span class="n">CALC_TARGET_NAME</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s2">选择“</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">OBJ_NAME</gydF4y2Baspan><span class="n">CALC_TARGET_APPROACH_NAME</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s2">的方法”</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">CALC_TARGET_NAME</gydF4y2Baspan><span class="n">APPROACH_DIST</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="c1">#毫米</gydF4y2Baspan><span class="c1">#检测</gydF4y2Baspan><span class="n">MATCH_DIST_THRESH</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mf">０．７５</gydF4y2Baspan><span class="c1">#洛氏比率门槛</gydF4y2Baspan><span class="n">MIN_MATCH</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">15</gydF4y2Baspan><span class="c1">#最小的SIFT匹配，认为检测有效</gydF4y2Baspan><span class="n">OBJ_IMG_PATH</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s2">＂＂</gydF4y2Baspan><span class="c1">#源图像的绝对路径保留空白以打开文件对话框。</gydF4y2Baspan><span class="c1">#绘制结果</gydF4y2Baspan><span class="n">DISPLAY_RESULT</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="c1">打开一个SIFT匹配的窗口</gydF4y2Baspan><span class="n">DRAW_AXIS_LENGTH</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">50</gydF4y2Baspan><span class="c1">#像素</gydF4y2Baspan><span class="n">DRAW_LINE_WEIGHT</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">#像素</gydF4y2Baspan><span class="n">DRAW_LINE_COLOR</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">255</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1"># RGB</gydF4y2Baspan><span class="c1">#----------------------------------</gydF4y2Baspan><span class="c1">#获取源图像进行识别</gydF4y2Baspan><span class="n">img_path</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">OBJ_IMG_PATH</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">img_path</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="s2">＂＂</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">img_path</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">getOpenFileName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">strtitle</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“选择源对象图像”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">defaultextension</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“使用”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">文件类型</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">((</gydF4y2Baspan><span class="s1">“PNG”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“使用”</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“JPEG”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“jpg”</gydF4y2Baspan><span class="p">）］）</gydF4y2Baspan><span class="n">img_object</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">imread</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img_path</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">IMREAD_GRAYSCALE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">img_object</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img_object</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“无法检索源图像进行识别!”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------</gydF4y2Baspan><span class="c1">#让角色认识自己</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">部分</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">OBJ_NAME</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_OBJECT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">部分</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“找不到零件!”</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">OBJ_NAME</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">part_frame</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">部分</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">父</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">part_frame</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">part_frame</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">类型</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="n">ITEM_TYPE_FRAME</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“部分父母无效，确保它是一个框架!”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------</gydF4y2Baspan><span class="c1">#从RoboDK获取模拟相机</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">CAM_NAME</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_CAMERA</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“找不到相机!”</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">CAM_NAME</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cam_tool</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">父</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">cam_tool</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">cam_tool</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">类型</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="n">ITEM_TYPE_TOOL</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“相机母是无效的，确保它是一个工具!”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------</gydF4y2Baspan><span class="c1">#获取或创建计算对象姿态框架</gydF4y2Baspan><span class="n">calc_frame</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">CALC_FRAME_NAME</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_FRAME</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">calc_frame</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">calc_frame</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddFrame</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">CALC_FRAME_NAME</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">part_frame</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">父</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="n">calc_pick</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">CALC_TARGET_NAME</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_TARGET</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">calc_pick</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">calc_pick</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddTarget</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">CALC_TARGET_NAME</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">calc_frame</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">calc_pick_approach</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">CALC_TARGET_APPROACH_NAME</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_TARGET</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">calc_pick_approach</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">calc_pick_approach</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddTarget</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">CALC_TARGET_APPROACH_NAME</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">calc_frame</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#开始摄像。</gydF4y2Baspan><span class="c1">#如果您使用的是联网设备，请使用cv。视频捕捉来获得现场直播。</gydF4y2Baspan><span class="c1"># https://docs.opencv.org/master/d8/dfe/classcv_1_1VideoCapture.html</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1"># capture = cv.VideoCapture(0)</gydF4y2Baspan><span class="c1"># retval, image = capture.read()</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#现在，我们需要在磁盘上保存RDK快照。</gydF4y2Baspan><span class="c1">#一个新的更新即将到来，它将返回图像，如:img = RDK。Cam2D_Snapshot (cam_item”)</gydF4y2Baspan><span class="n">tempdir</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">tempfile</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">gettempdir</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">snapshot_file</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">tempdir</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="se">\ \</gydF4y2Baspan><span class="s2">sift_temp.png”</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#处理相机帧</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="n">PROCESS_COUNT</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">PROCESS_COUNT</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">+ =</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#保存并从RoboDK获取图像</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Cam2D_Snapshot</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">snapshot_file</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">img_scene</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">imread</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">snapshot_file</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">IMREAD_GRAYSCALE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#使用SIFT检测器检测关键点，计算描述符</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SIFT_create</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">keypoints_obj</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">descriptors_obj</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">detectAndCompute</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img_object</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">keypoints_scene</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">descriptors_scene</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">detectAndCompute</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img_scene</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">descriptors_obj</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">descriptors_scene</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">keypoints_obj</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="p">［］</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">keypoints_scene</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="p">［］:</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“无法发现关键点”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">继续</gydF4y2Baspan><span class="c1">#匹配描述符向量</gydF4y2Baspan><span class="n">匹配器</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">DescriptorMatcher_create</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">DescriptorMatcher_FLANNBASED</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">knn_matches</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">匹配器</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">knnMatch</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">descriptors_obj</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">descriptors_scene</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#过滤器匹配使用Lowe's比率测试</gydF4y2Baspan><span class="n">good_matches</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［］</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">米</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">n</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">knn_matches</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">米</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">距离</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="n">MATCH_DIST_THRESH</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">n</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">距离</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">good_matches</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">附加</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">米</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#绘制匹配</gydF4y2Baspan><span class="n">img_matches</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">空</gydF4y2Baspan><span class="p">（(</gydF4y2Baspan><span class="nb">马克斯</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img_object</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">img_scene</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">]),</gydF4y2Baspan><span class="n">img_object</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">img_scene</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="n">dtype</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">uint8</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">drawMatches</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img_object</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">keypoints_obj</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">img_scene</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">keypoints_scene</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">good_matches</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">img_matches</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">旗帜</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">DrawMatchesFlags_NOT_DRAW_SINGLE_POINTS</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#停止处理低匹配计数</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">good_matches</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="n">MIN_MATCH</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“火柴不够”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">继续</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#定位对象</gydF4y2Baspan><span class="n">obj</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">空</gydF4y2Baspan><span class="p">（(</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">good_matches</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="n">dtype</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">float32</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">场景</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">空</gydF4y2Baspan><span class="p">（(</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">good_matches</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="n">dtype</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">float32</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">范围</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">good_matches</gydF4y2Baspan><span class="p">)):</gydF4y2Baspan><span class="c1">#从优秀的匹配中获取关键点</gydF4y2Baspan><span class="n">obj</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">keypoints_obj</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">good_matches</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">queryIdx</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">pt</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">obj</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">keypoints_obj</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">good_matches</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">queryIdx</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">pt</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">场景</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">keypoints_scene</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">good_matches</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">trainIdx</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">pt</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">场景</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">keypoints_scene</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">good_matches</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">trainIdx</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">pt</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1">#计算透视变换，或单应矩阵</gydF4y2Baspan><span class="n">H</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">＿</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">findHomography</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">obj</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">场景</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">RANSAC</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">H</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">H</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“不可能转变”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">继续</gydF4y2Baspan><span class="c1">#我们可以直接从H中提取旋转角度</gydF4y2Baspan><span class="n">θ</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">数学</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">量化</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">H</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">H</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">有很多方法来计算姿势。</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1"># 1。使用相机矩阵</gydF4y2Baspan><span class="c1">#如果你有一个校准的相机(模拟或硬件)，你可以分解H并得到旋转和平移的解决方案(最多四个解决方案)。</gydF4y2Baspan><span class="c1">#查看如何校准相机的示例:</gydF4y2Baspan><span class="c1"># - //m.sinclairbody.com/doc/en/PythonAPI/examples.html#camera-calibration</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1"># cam_mtx = np.array([[1.3362190822261939e+ 04,0 .]， 8.4795067509033629e+02]， [0.]，1．3.361819220.999134e+04, 1.6875586379396785e+02], [0., 0., 1.]]) # Sample camera matrix from a 1280x720 simulated camera</span><span class="c1"># n_solution, rot, trans, normals = cv.decomposeHomographyMat(H, cam_mtx)</gydF4y2Baspan><span class="c1"># for I in range(n_solution):</gydF4y2Baspan><span class="c1"># vx, vy, vz = rot[i].tolist()</gydF4y2Baspan><span class="c1"># tx, ty, tz = trans[i].tolist()</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1"># 2。使用的时刻</gydF4y2Baspan><span class="c1">#这种方法没有考虑到相机矩阵，小的误差是预期的。</gydF4y2Baspan><span class="c1">更多信息，请访问:</gydF4y2Baspan><span class="c1"># - https://en.wikipedia.org/wiki/Image_moment</gydF4y2Baspan><span class="c1"># - https://docs.opencv.org/master/d8/d23/classcv_1_1Moments.html</gydF4y2Baspan><span class="c1">#从物体图像中获取角</gydF4y2Baspan><span class="n">obj_corners</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">0</gydF4y2Baspan><span class="p">（(</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="n">dtype</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">float32</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1"># corder id, x, y</gydF4y2Baspan><span class="n">obj_corners</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">img_object</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">obj_corners</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">img_object</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">obj_corners</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">img_object</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">obj_corners</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">img_object</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1">#转换对象角到相机图像</gydF4y2Baspan><span class="n">scene_corners</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">perspectiveTransform</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">obj_corners</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">H</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#获取图像瞬间，并提取中心</gydF4y2Baspan><span class="n">时刻</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">时刻</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">scene_corners</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">残雪</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">时刻</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s1">“m10”</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="n">时刻</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s1">“m00”</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">cy</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">时刻</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s1">“m01”</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="n">时刻</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s1">“m00”</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#计算X和Y相对于相机框架</gydF4y2Baspan><span class="n">rel_x</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">残雪</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">CAMERA_SIZE_X</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mf">2．0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">PIXEL_SIZE_X</gydF4y2Baspan><span class="n">rel_y</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">cy</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">CAMERA_SIZE_Y</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mf">2．0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">PIXEL_SIZE_Y</gydF4y2Baspan><span class="n">rel_theta</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">浮动</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">θ</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#以容忍为中心</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">腹肌</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">rel_x</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">rel_x</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mf">0．0</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">腹肌</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">rel_y</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">rel_y</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mf">0．0</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">腹肌</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">rel_theta</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="mf">0.0005</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">rel_theta</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mf">0．0</gydF4y2Baspan><span class="c1">#精度公差</gydF4y2Baspan><span class="n">rel_x</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">轮</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">rel_x</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">rel_y</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">轮</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">rel_y</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">rel_theta</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">轮</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">rel_theta</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#计算对相机的姿势wrt</gydF4y2Baspan><span class="n">calc_frame_pose</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">cam_tool</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">calc_frame_pose</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPos</gydF4y2Baspan><span class="p">([</gydF4y2Baspan><span class="n">rel_x</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">rel_y</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">Z_OFFSET</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="n">calc_frame_pose</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">calc_frame_pose</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">rotz</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">rel_theta</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">计算一组相对姿势的懒方法是静态移动它们!</gydF4y2Baspan><span class="n">calc_frame</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParent</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">cam_tool</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">calc_frame</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">calc_frame_pose</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">calc_pick</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">眼睛</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">4</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">calc_pick_approach</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">calc_pick</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">transl</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">APPROACH_DIST</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">calc_frame</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParentStatic</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">part_frame</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#向用户显示检测结果(参考图和摄像头图像并列显示检测结果)</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">DISPLAY_RESULT</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">旋转</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">起源</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">角</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""绕一个给定的原点逆时针旋转一个给定的角度(弧度)。"＂＂</gydF4y2Baspan><span class="n">牛</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">oy</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">起源</gydF4y2Baspan><span class="n">px</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">py</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="n">qx、</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">牛</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">数学</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">因为</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">角</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">px</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">牛</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">数学</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">罪</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">角</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">py</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">oy</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">qy</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">oy</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">数学</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">罪</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">角</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">px</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">牛</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">数学</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">因为</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">角</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">py</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">oy</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="n">qx、</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">qy</gydF4y2Baspan><span class="c1">#构造绘图参数</gydF4y2Baspan><span class="n">cx_off</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">img_object</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">center_pt</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">残雪</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">cx_off</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">cy</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">x_axis</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">center_pt</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">DRAW_AXIS_LENGTH</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">center_pt</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="n">x_axis</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">旋转</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">center_pt</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">x_axis</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">θ</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">y_axis</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">旋转</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">center_pt</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">x_axis</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mf">2．0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">center_pt</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">center_pt</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">]),</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">center_pt</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">)))</gydF4y2Baspan><span class="n">x_axis</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">x_axis</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">]),</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">x_axis</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">)))</gydF4y2Baspan><span class="n">y_axis</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">y_axis</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">]),</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">y_axis</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">)))</gydF4y2Baspan><span class="c1">绘制被检测物体的方向矢量</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">圆</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img_matches</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">center_pt</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">255</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">255</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">arrowedLine</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img_matches</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">center_pt</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">x_axis</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">255</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">LINE_AA</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1"># X</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">arrowedLine</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img_matches</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">center_pt</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">y_axis</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">255</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">LINE_AA</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1"># Y</gydF4y2Baspan><span class="c1">#在检测到的物体的角之间画线</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img_matches</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">scene_corners</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">img_object</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">]),</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">scene_corners</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">))),</gydF4y2Baspan>＼<gydF4y2Baspan class="p">（</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">scene_corners</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">img_object</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">]),</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">scene_corners</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">))),</gydF4y2Baspan><span class="n">DRAW_LINE_COLOR</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">DRAW_LINE_WEIGHT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img_matches</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">scene_corners</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">img_object</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">]),</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">scene_corners</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">))),</gydF4y2Baspan>＼<gydF4y2Baspan class="p">（</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">scene_corners</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">img_object</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">]),</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">scene_corners</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">))),</gydF4y2Baspan><span class="n">DRAW_LINE_COLOR</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">DRAW_LINE_WEIGHT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img_matches</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">scene_corners</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">img_object</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">]),</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">scene_corners</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">))),</gydF4y2Baspan>＼<gydF4y2Baspan class="p">（</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">scene_corners</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">img_object</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">]),</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">scene_corners</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">))),</gydF4y2Baspan><span class="n">DRAW_LINE_COLOR</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">DRAW_LINE_WEIGHT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">行</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img_matches</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">scene_corners</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">img_object</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">]),</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">scene_corners</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">3.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">))),</gydF4y2Baspan>＼<gydF4y2Baspan class="p">（</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">scene_corners</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">img_object</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">]),</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">scene_corners</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">))),</gydF4y2Baspan><span class="n">DRAW_LINE_COLOR</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">DRAW_LINE_WEIGHT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#显示检测到的匹配</gydF4y2Baspan><span class="n">wdw_name</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“RoboDK -匹配和检测对象”</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">imshow</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">wdw_name</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">img_matches</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">waitKey</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">27</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">打破</gydF4y2Baspan><span class="c1">#用户按ESC退出</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getWindowProperty</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">wdw_name</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">WND_PROP_VISIBLE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">打破</gydF4y2Baspan><span class="c1">#用户关闭主窗口，退出</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">destroyAllWindows</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="blob-detection"> <h3><span class="section-number">6.35.2.</gydF4y2Baspan>Blob检测<一个class="headerlink" href="#blob-detection" title="¶＂>gydF4y2Ba¶</一个></h3.><p>这个例子展示了如何使用OpenCV检测简单的几何形状(blob)。它使用模拟摄像头，但可以很容易地修改为使用输入摄像头。你可以在<一个class="reference external" href="https://docs.opencv.org/master/d3/d05/tutorial_py_table_of_contents_contours.html">OpenCV轮廓教程</一个>．</p><一个class="reference internal image-reference" href="//m.sinclairbody.com/doc/en/PythonAPI/_images/BlobDetection.png"><img alt="_images / BlobDetection.png＂class="align-center" src="//m.sinclairbody.com/doc/en/PythonAPI/_images/BlobDetection.png" style="width: 60%;"></a> <div class="literal-block-wrapper docutils container" id="id10"> <div class="code-block-caption"> <span class="caption-text">Blob检测</gydF4y2Baspan> <a class="headerlink" href="#id10" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">输入help("robolink")或help("robodk")查看更多信息</gydF4y2Baspan><span class="c1">#按F5运行脚本</gydF4y2Baspan><span class="c1">#文档://m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">#参考://m.sinclairbody.com/doc/en/PythonAPI/index.html</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">这个例子展示了如何使用OpenCV检测相机提要中的斑点。</gydF4y2Baspan><span class="c1">#它使用模拟摄像头，但它可以很容易地修改为使用输入摄像头。</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">你可以在OpenCV Contours教程中找到更多信息:</gydF4y2Baspan><span class="c1"># https://docs.opencv.org/master/d3/d05/tutorial_py_table_of_contents_contours.html</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># RoboDK API</gydF4y2Baspan><span class="n">import_install</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“cv2”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“opencv-python”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">cv2</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="nn">简历</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">numpy</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="nn">np</gydF4y2Baspan><span class="c1">#----------------------------------</gydF4y2Baspan><span class="c1">#设置</gydF4y2Baspan><span class="n">PROCESS_COUNT</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">#退出前要处理多少帧。-1表示无限。</gydF4y2Baspan><span class="n">CAM_NAME</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s2">“相机”</gydF4y2Baspan><span class="n">DISPLAY_SETTINGS</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">RoboDK - Blob检测参数</gydF4y2Baspan><span class="n">DISPLAY_RESULT</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="n">WDW_NAME_RESULTS</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“RoboDK -斑点检测”</gydF4y2Baspan><span class="c1">#----------------------------------</gydF4y2Baspan><span class="c1">#从RoboDK获取模拟相机</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">CAM_NAME</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_CAMERA</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“找不到相机!”</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">CAM_NAME</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“开放”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#强制打开相机视图</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">使用默认参数设置检测器。</gydF4y2Baspan><span class="c1">#默认参数提取黑色圆形斑点。</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SimpleBlobDetector_Params</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SimpleBlobDetector_create</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#设置参数滑块，使用OpenCV的跟踪条</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">DISPLAY_SETTINGS</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">namedWindow</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">WINDOW_FREERATIO</gydF4y2Baspan><span class="o">|</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">WINDOW_GUI_EXPANDED</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">minDistBetweenBlobs</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""两个斑点之间的最小距离，以像素为单位。"＂＂</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">minDistBetweenBlobs</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SimpleBlobDetector_create</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#图像阈值</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">minThreshold</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""最小强度阈值，uint8。"＂＂</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">minThreshold</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SimpleBlobDetector_create</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">maxThreshold</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""最大强度阈值，uint8。"＂＂</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">maxThreshold</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SimpleBlobDetector_create</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">thresholdStep</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">""强度阈值步骤之间的最小和最大阈值，在uint8。"＂＂</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">thresholdStep</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">马克斯</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SimpleBlobDetector_create</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">minRepeatability</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""在整个阈值步骤中检测到一个斑点的最小数量。"＂＂</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">minRepeatability</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">马克斯</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SimpleBlobDetector_create</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#按区域过滤</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">filterByArea</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""启用按blob区域过滤。"＂＂</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">filterByArea</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SimpleBlobDetector_create</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">minArea</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""最小斑点面积，单位为像素^2。"＂＂</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">minArea</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SimpleBlobDetector_create</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">maxArea</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""最大斑点面积，单位为像素^2。"＂＂</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">maxArea</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SimpleBlobDetector_create</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#过滤圆度(4*pi*面积/周长^2)</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">filterByCircularity</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""启用blob循环过滤。"＂＂</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">filterByCircularity</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SimpleBlobDetector_create</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">minCircularity</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""最小团圆度，单位为%。"＂＂</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">minCircularity</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SimpleBlobDetector_create</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">maxCircularity</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""最大斑点圆度，单位为%。"＂＂</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">maxCircularity</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SimpleBlobDetector_create</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#凸度过滤器(面积/斑点凸包面积)</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">filterByConvexity</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""启用blob凸性过滤。"＂＂</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">filterByConvexity</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SimpleBlobDetector_create</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">minConvexity</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""最小团凸度，单位为%。"＂＂</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">minConvexity</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SimpleBlobDetector_create</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">maxConvexity</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""最大斑点凸度，以%为单位。"＂＂</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">maxConvexity</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SimpleBlobDetector_create</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#滤镜颜色(明暗)</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">filterByColor</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""启用按斑点颜色过滤。"＂＂</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">filterByColor</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SimpleBlobDetector_create</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">blobColor</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""颜色的斑点，在uint8。"＂＂</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">blobColor</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="c1">#[0(暗)，255(亮)]</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SimpleBlobDetector_create</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">惯量过滤器(伸长)</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">filterByInertia</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""启用blob惯性过滤。"＂＂</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">filterByInertia</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SimpleBlobDetector_create</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">minInertiaRatio</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""最小blob惯性，单位%。"＂＂</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">minInertiaRatio</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="c1"># [0,1]</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SimpleBlobDetector_create</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">maxInertiaRatio</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""最大blob惯性，单位%。"＂＂</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="k">全球</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">maxInertiaRatio</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">价值</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="c1"># [0,1]</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">SimpleBlobDetector_create</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#所有范围从0到'count'，初始化为默认值。</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">的距离</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">最小值的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">minDistBetweenBlobs</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">999</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">minDistBetweenBlobs</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“打</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">最小值的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">minThreshold</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">255</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">minThreshold</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“打</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">最大的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">maxThreshold</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">255</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">maxThreshold</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“打</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">Stp的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">thresholdStep</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">255</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">thresholdStep</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“打</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">代表的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">minRepeatability</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">minRepeatability</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">的区域</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">在“</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">保龄球</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">filterByArea</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">filterByArea</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">的区域</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">最小值的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">minArea</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">500</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">minArea</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">的区域</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">最大的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">maxArea</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">5000</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">maxArea</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“中国保监会</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">在“</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">保龄球</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">filterByCircularity</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">filterByCircularity</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“中国保监会</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">最小值的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">minCircularity</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">500</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">minCircularity</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“中国保监会</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">最大的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">最小值</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">500</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">maxCircularity</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="p">）），</gydF4y2Baspan><span class="mi">500</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">maxCircularity</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“Conv</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">在“</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">保龄球</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">filterByConvexity</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">filterByConvexity</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“Conv</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">最小值的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">minConvexity</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">500</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">minConvexity</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“Conv</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">最大的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">最小值</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">500</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">maxConvexity</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="p">）），</gydF4y2Baspan><span class="mi">500</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">maxConvexity</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">的颜色</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">在“</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">保龄球</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">filterByColor</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">filterByColor</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“颜色”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">blobColor</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">255</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">blobColor</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">的惰性</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">在“</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">保龄球</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">filterByInertia</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">filterByInertia</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">的惰性</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">最小值的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">minInertiaRatio</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">minInertiaRatio</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">的惰性</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">最大的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">最小值</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">参数个数</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">maxInertiaRatio</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="p">）），</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">maxInertiaRatio</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#创建可调整大小的结果窗口</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">DISPLAY_RESULT</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">namedWindow</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">WDW_NAME_RESULTS</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1"># cv.WINDOW_NORMAL)</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#开始摄像。</gydF4y2Baspan><span class="c1">#如果您使用的是联网设备，请使用cv。视频捕捉来获得现场直播。</gydF4y2Baspan><span class="c1"># https://docs.opencv.org/master/d8/dfe/classcv_1_1VideoCapture.html</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1"># capture = cv.VideoCapture(0)</gydF4y2Baspan><span class="c1"># retval, image = capture.read()</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#处理相机帧</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="n">PROCESS_COUNT</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">PROCESS_COUNT</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">"============================================="</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“处理图片</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">+ =</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#从RoboDK获取图像</gydF4y2Baspan><span class="n">bytes_img</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Cam2D_Snapshot</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">＂＂</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">bytes_img</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="sa">b</gydF4y2Baspan><span class="s1">”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="c1">#图片来自RoboDK是BGR, uchar， (h,w,3)</gydF4y2Baspan><span class="n">nparr</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">frombuffer</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">bytes_img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">uint8</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">imdecode</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">nparr</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">IMREAD_UNCHANGED</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#检测斑点</gydF4y2Baspan><span class="n">要点</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">探测器</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">检测</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">关键点</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">要点</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="nb">打印</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">id:</gydF4y2Baspan><span class="si">%我</gydF4y2Baspan><span class="s2">coord = (</gydF4y2Baspan><span class="si">% 0.0度</gydF4y2Baspan><span class="s2">，</gydF4y2Baspan><span class="si">% 0.0度</gydF4y2Baspan><span class="s2">）"</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">关键点</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">pt</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">关键点</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">pt</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">)))</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">+ =</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#用你的探测做点什么!</gydF4y2Baspan><span class="c1">下面是一些例子:</gydF4y2Baspan><span class="c1"># -如果关键点(螺丝孔)的数量不是3个，就拒绝一个零件</gydF4y2Baspan><span class="c1"># -计算每个关键点的世界坐标来移动机器人</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#向用户显示检测结果(参考图和摄像头图像并列显示检测结果)</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">DISPLAY_RESULT</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#绘制检测到的斑点及其id</gydF4y2Baspan><span class="n">img_matches</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">drawKeypoints</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">要点</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">255</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">DRAW_MATCHES_FLAGS_DRAW_RICH_KEYPOINTS</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">关键点</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">要点</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">y</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">关键点</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">pt</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">putText</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img_matches</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">str</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">x</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">y</gydF4y2Baspan><span class="p">）），</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">FONT_HERSHEY_SIMPLEX</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">255</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">LINE_AA</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">+ =</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">#调整图像大小，使其适合屏幕</gydF4y2Baspan><span class="n">img_matches</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">调整</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img_matches</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img_matches</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="mf">综合成绩</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img_matches</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="mf">综合成绩</gydF4y2Baspan><span class="p">）））</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">imshow</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">WDW_NAME_RESULTS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">img_matches</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">waitKey</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">500</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">27</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">打破</gydF4y2Baspan><span class="c1">#用户按ESC退出</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getWindowProperty</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">WDW_NAME_RESULTS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">WND_PROP_VISIBLE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">打破</gydF4y2Baspan><span class="c1">#用户关闭窗口，退出</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">destroyAllWindows</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="orientation-of-elongated-parts"> <h3><span class="section-number">6.35.3.</gydF4y2Baspan>拉长部分的方向<一个class="headerlink" href="#orientation-of-elongated-parts" title="¶＂>gydF4y2Ba¶</一个></h3.><p>这个例子展示了如何使用OpenCV检测相机馈电中拉长部分的方向。它使用模拟摄像头，但可以很容易地修改为使用输入摄像头。你可以在<一个class="reference external" href="https://docs.opencv.org/master/d3/d05/tutorial_py_table_of_contents_contours.html">OpenCV轮廓教程</一个>．</p><一个class="reference internal image-reference" href="//m.sinclairbody.com/doc/en/PythonAPI/_images/PartOrientation.png"><img alt="_images / PartOrientation.png＂class="align-center" src="//m.sinclairbody.com/doc/en/PythonAPI/_images/PartOrientation.png" style="width: 60%;"></a> <div class="literal-block-wrapper docutils container" id="part-orientation"> <div class="code-block-caption"> <span class="caption-text">部分取向</gydF4y2Baspan> <a class="headerlink" href="#part-orientation" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">输入help("robolink")或help("robodk")查看更多信息</gydF4y2Baspan><span class="c1">#按F5运行脚本</gydF4y2Baspan><span class="c1">#文档://m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">#参考://m.sinclairbody.com/doc/en/PythonAPI/index.html</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">这个例子展示了如何使用OpenCV检测相机馈电中拉长部分的方向。</gydF4y2Baspan><span class="c1">#它使用模拟摄像头，但它可以很容易地修改为使用输入摄像头。</gydF4y2Baspan><span class="c1">#警告:最好的效果是观察对称的拉长部分。</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">你可以在OpenCV Contours教程中找到更多信息:</gydF4y2Baspan><span class="c1"># https://docs.opencv.org/master/d3/d05/tutorial_py_table_of_contents_contours.html</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># RoboDK API</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robomath</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1">#机器人工具箱</gydF4y2Baspan><span class="n">import_install</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“cv2”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“opencv-contrib-python”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">cv2</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="nn">简历</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">numpy</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="nn">np</gydF4y2Baspan><span class="c1">#----------------------------------</gydF4y2Baspan><span class="c1">#设置</gydF4y2Baspan><span class="n">PROCESS_COUNT</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">#退出前要处理多少帧。-1表示无限。</gydF4y2Baspan><span class="n">CAM_NAME</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s2">“相机”</gydF4y2Baspan><span class="n">DISPLAY_SETTINGS</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">RoboDK -零件方向参数</gydF4y2Baspan><span class="n">DISPLAY_RESULT</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="n">WDW_NAME_RESULTS</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“RoboDK -零件定位”</gydF4y2Baspan><span class="n">DRAW_AXIS_LENGTH</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">30.</gydF4y2Baspan><span class="n">THRESH_MIN</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">50</gydF4y2Baspan><span class="n">THRESH_MAX</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">255</gydF4y2Baspan><span class="n">LENGTH_MIN</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="n">LENGTH_MAX</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">400</gydF4y2Baspan><span class="n">AREA_MIN</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">400</gydF4y2Baspan><span class="n">AREA_MAX</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">1000</gydF4y2Baspan><span class="c1">#----------------------------------</gydF4y2Baspan><span class="c1">#从RoboDK获取模拟相机</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">CAM_NAME</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_CAMERA</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="ne">异常</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“找不到相机!”</gydF4y2Baspan><span class="si">% s</gydF4y2Baspan><span class="s2">＂</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">CAM_NAME</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“开放”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#强制打开相机视图</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#开始摄像。</gydF4y2Baspan><span class="c1">#如果您使用的是联网设备，请使用cv。视频捕捉来获得现场直播。</gydF4y2Baspan><span class="c1"># https://docs.opencv.org/master/d8/dfe/classcv_1_1VideoCapture.html</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1"># capture = cv.VideoCapture(0)</gydF4y2Baspan><span class="c1"># retval, image = capture.read()</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#创建一个可调整大小的结果窗口，其中包含参数滑块</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">DISPLAY_RESULT</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">namedWindow</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">WDW_NAME_RESULTS</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">DISPLAY_SETTINGS</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">没有什么</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">瓦尔</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="k">通过</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">namedWindow</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“打</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">最小值的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">THRESH_MIN</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">255</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">没有什么</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“打</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">最大的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">THRESH_MAX</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">255</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">没有什么</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">的长度</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">最小值的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">LENGTH_MIN</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1000</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">没有什么</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">的长度</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">最大的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">LENGTH_MAX</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">2500</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">没有什么</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">的区域</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">最小值的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">AREA_MIN</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1000</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">没有什么</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">createTrackbar</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">的区域</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">最大的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">AREA_MAX</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">2500</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">没有什么</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#处理相机帧</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="n">PROCESS_COUNT</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">PROCESS_COUNT</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">数</gydF4y2Baspan><span class="o">+ =</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#从RoboDK获取图像(从5.3.0开始)</gydF4y2Baspan><span class="n">bytes_img</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Cam2D_Snapshot</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">＂＂</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">bytes_img</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="sa">b</gydF4y2Baspan><span class="s1">”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="c1">#图片来自RoboDK是BGR, uchar， (h,w,3)</gydF4y2Baspan><span class="n">nparr</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">frombuffer</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">bytes_img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">uint8</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">imdecode</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">nparr</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">IMREAD_UNCHANGED</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">形状</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">获取此迭代的滑块值</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">DISPLAY_SETTINGS</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">THRESH_MIN</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getTrackbarPos</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“打</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">最小值的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">THRESH_MAX</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getTrackbarPos</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“打</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">最大的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">LENGTH_MIN</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getTrackbarPos</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">的长度</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">最小值的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">LENGTH_MAX</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getTrackbarPos</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">的长度</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">最大的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">AREA_MIN</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getTrackbarPos</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">的区域</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">最小值的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">AREA_MAX</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getTrackbarPos</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">的区域</gydF4y2Baspan><span class="se">\ n</gydF4y2Baspan><span class="s1">最大的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">WDW_NAME_PARAMS</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#提取特征最简单的方法是根据背景对其强度进行阈值</gydF4y2Baspan><span class="c1">#浅色部分在深色背景上的最佳效果，反之亦然</gydF4y2Baspan><span class="n">＿</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">img_bw</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">阈值</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">cvtColor</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">COLOR_BGR2GRAY</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="n">THRESH_MIN</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">THRESH_MAX</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">THRESH_BINARY</gydF4y2Baspan><span class="o">|</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">THRESH_OTSU</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">查找并解析二值图像中的所有轮廓</gydF4y2Baspan><span class="n">轮廓</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">＿</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">findContours</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img_bw</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">RETR_LIST</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">CHAIN_APPROX_NONE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">c</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="nb">列举</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">轮廓</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="n">拒绝</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="c1">#计算轮廓线的长度(只适用于CHAIN_APPROX_NONE)</gydF4y2Baspan><span class="n">长度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">len</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">c</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">长度</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="n">LENGTH_MIN</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">长度</gydF4y2Baspan><span class="o">></gydF4y2Baspan><span class="n">LENGTH_MAX</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">拒绝</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="c1">计算轮廓的面积</gydF4y2Baspan><span class="n">区域</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">contourArea</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">c</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">区域</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="n">AREA_MIN</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">区域</gydF4y2Baspan><span class="o">></gydF4y2Baspan><span class="n">AREA_MAX</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">拒绝</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#创建轮廓的包围框</gydF4y2Baspan><span class="n">矩形</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">minAreaRect</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">c</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">中心</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">矩形</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">矩形</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="n">宽度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">矩形</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">高度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">矩形</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">] [</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">角</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">弧度</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">矩形</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="c1">#角度为[0,90]，从水平方向到方框的左下和右下边缘</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">宽度</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="n">高度</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">角</gydF4y2Baspan><span class="o">+ =</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mf">2．0</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">角</gydF4y2Baspan><span class="o">></gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">角</gydF4y2Baspan><span class="o">- =</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#你也可以最适合一个椭圆和使用它的角度</gydF4y2Baspan><span class="c1">#if长度为></gydF4y2Baspan><span class="c1"># ell = cv.fitEllipse(c)</gydF4y2Baspan><span class="c1"># center = (ell[0][0]， ell[0][1])</gydF4y2Baspan><span class="c1"># width = ell[1][0]</gydF4y2Baspan><span class="c1"># height = ell[1][1]</gydF4y2Baspan><span class="c1">#角度= np.radians(ell[2])</gydF4y2Baspan><span class="c1"># if width < height:</gydF4y2Baspan><span class="c1">#角度+= PI / 2.0</gydF4y2Baspan><span class="c1"># if angle2 > pi:</gydF4y2Baspan><span class="c1">#角度-= PI</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#用你的探测做点什么!</gydF4y2Baspan><span class="c1">下面是一些例子:</gydF4y2Baspan><span class="c1"># -如果零件的朝向与预期不同，则拒绝该零件</gydF4y2Baspan><span class="c1"># -如果零件面积太小，就拒绝它</gydF4y2Baspan><span class="c1"># -计算机器人的旋转角度来挑选零件</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#向用户显示检测结果(参考图和摄像头图像并列显示检测结果)</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">DISPLAY_RESULT</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">颜色</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">255</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">拒绝</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">颜色</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">255</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#绘制边界框</gydF4y2Baspan><span class="n">盒子</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">boxPoints</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">矩形</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">盒子</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">int0</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">盒子</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">drawContours</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">盒子</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">颜色</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">绘制轮廓线</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">drawContours</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">轮廓</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">颜色</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">拒绝</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">旋转</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">起源</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">角</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="sd">"""绕一个给定的原点逆时针旋转一个给定的角度(弧度)。"＂＂</gydF4y2Baspan><span class="n">牛</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">oy</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">起源</gydF4y2Baspan><span class="n">px</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">py</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="n">qx、</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">牛</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">数学</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">因为</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">角</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">px</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">牛</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">数学</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">罪</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">角</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">py</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">oy</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">qy</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">oy</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">数学</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">罪</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">角</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">px</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">牛</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">数学</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">因为</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">角</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">py</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="n">oy</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="n">qx、</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">qy</gydF4y2Baspan><span class="c1">#构造Axis参数</gydF4y2Baspan><span class="n">center_pt</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">中心</gydF4y2Baspan><span class="n">x_axis</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">center_pt</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="n">DRAW_AXIS_LENGTH</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">center_pt</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="n">x_axis</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">旋转</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">center_pt</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">x_axis</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">角</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">y_axis</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">旋转</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">center_pt</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">x_axis</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mf">2．0</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">center_pt</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">center_pt</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">]),</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">center_pt</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">)))</gydF4y2Baspan><span class="n">x_axis</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">x_axis</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">]),</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">x_axis</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">)))</gydF4y2Baspan><span class="n">y_axis</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">y_axis</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">]),</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">y_axis</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">)))</gydF4y2Baspan><span class="c1">#绘制方向矢量</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">圆</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">center_pt</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">255</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">arrowedLine</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">center_pt</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">x_axis</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">255</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">LINE_AA</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">arrowedLine</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">center_pt</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">y_axis</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">255</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">LINE_AA</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#绘制角度</gydF4y2Baspan><span class="n">标签</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="si">% 0.1度</gydF4y2Baspan><span class="s1">＇</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">度</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">角</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">putText</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">标签</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">center_pt</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="mi">30.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">center_pt</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">]),</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">FONT_HERSHEY_SIMPLEX</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mf">0.7</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">255</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">255</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">255</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">LINE_AA</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">imshow</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">WDW_NAME_RESULTS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">img</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">waitKey</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">27</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">打破</gydF4y2Baspan><span class="c1">#用户按ESC退出</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getWindowProperty</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">WDW_NAME_RESULTS</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">WND_PROP_VISIBLE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">打破</gydF4y2Baspan><span class="c1">#用户关闭主窗口，退出</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">destroyAllWindows</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan></pre> </div> </div> </div> </div> </div> <div class="section" id="depth-camera"> <h2><span class="section-number">6.36.</gydF4y2Baspan>深度相机<一个class="headerlink" href="#depth-camera" title="¶＂>gydF4y2Ba¶</一个></h2><div class="section" id="depth-map"> <h3><span class="section-number">6.36.1.</gydF4y2Baspan>深度图<一个class="headerlink" href="#depth-map" title="¶＂>gydF4y2Ba¶</一个></h3.><p>此示例演示如何检索和显示模拟摄像机的32位深度图。</p><一个class="reference internal image-reference" href="//m.sinclairbody.com/doc/en/PythonAPI/_images/example_depth_camera.png"><img alt="_images / example_depth_camera.png＂class="align-center" src="//m.sinclairbody.com/doc/en/PythonAPI/_images/example_depth_camera.png" style="width: 60%;"></a> <div class="literal-block-wrapper docutils container" id="id12"> <div class="code-block-caption"> <span class="caption-text">深度相机</gydF4y2Baspan> <a class="headerlink" href="#id12" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">输入help("robolink")或help("robodk")查看更多信息</gydF4y2Baspan><span class="c1">#按F5运行脚本</gydF4y2Baspan><span class="c1">#文档://m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">#参考://m.sinclairbody.com/doc/en/PythonAPI/index.html</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">这个例子展示了如何检索和显示一个模拟相机的32位深度图。</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="c1"># RoboDK API</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">tempfile</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="n">TemporaryDirectory</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">numpy</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="nn">np</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">matplotlib</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="n">pyplot</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="n">plt</gydF4y2Baspan><span class="c1">#----------------------------------</gydF4y2Baspan><span class="c1">#从RoboDK获取模拟相机</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“深度相机”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_CAMERA</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Cam2D_Add</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ActiveStation</gydF4y2Baspan><span class="p">()，</gydF4y2Baspan><span class="s1">“深度”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“深度相机”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“开放”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#从RoboDK获取图像</gydF4y2Baspan><span class="n">道明</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">TemporaryDirectory</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">前缀</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“robodk_”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">特遣部队</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">道明</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">的名字</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s1">' / temp.grey32 '</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Cam2D_Snapshot</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">特遣部队</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">grey32</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">fromfile</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">特遣部队</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">dtype</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">> u4的</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">grey32</gydF4y2Baspan><span class="p">[:</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">grey32</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">flipud</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">重塑</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">grey32</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">:,</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="p">）））</gydF4y2Baspan><span class="k">其他的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">提高</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#显示</gydF4y2Baspan><span class="n">grey32</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">grey32</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="o">**</gydF4y2Baspan><span class="mi">32</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="c1">这只是为了展示!0的值没有任何测量值。</gydF4y2Baspan><span class="n">plt</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">imshow</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">grey32</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“灰色”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">plt</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">显示</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="mesh-reconstruction"> <h3><span class="section-number">6.36.2.</gydF4y2Baspan>网格重建<一个class="headerlink" href="#mesh-reconstruction" title="¶＂>gydF4y2Ba¶</一个></h3.><p>这个例子展示了如何使用Open3D将深度图转换为网格对象。使用Stanford Bunny和RoboDK模拟摄像机，您可以提取32位深度图，将其转换为点云，近似网格，在3D查看器中可视化，并将对象导入RoboDK。</p><一个class="reference internal image-reference" href="//m.sinclairbody.com/doc/en/PythonAPI/_images/DepthCameraOpen3D.png"><img alt="_images / DepthCameraOpen3D.png＂class="align-center" src="//m.sinclairbody.com/doc/en/PythonAPI/_images/DepthCameraOpen3D.png" style="width: 60%;"></a> <div class="literal-block-wrapper docutils container" id="id13"> <div class="code-block-caption"> <span class="caption-text">网格重建</gydF4y2Baspan> <a class="headerlink" href="#id13" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">输入help("robolink")或help("robodk")查看更多信息</gydF4y2Baspan><span class="c1">#按F5运行脚本</gydF4y2Baspan><span class="c1">#文档://m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">#参考://m.sinclairbody.com/doc/en/PythonAPI/index.html</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">这个例子展示了如何从一个模拟相机的32位深度图重建一个网格。</gydF4y2Baspan><span class="c1">#它使用Open3D将深度图转换为点云，以重建网格和可视化。</gydF4y2Baspan><span class="c1">左键单击视图，在查看器中移动网格。</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">tempfile</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="n">TemporaryDirectory</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">numpy</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="nn">np</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">open3d</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="nn">o3d</gydF4y2Baspan><span class="c1">#----------------------------------</gydF4y2Baspan><span class="c1">#你可能需要根据对象/设置来进行这些设置</gydF4y2Baspan><span class="n">CAMERA_NAME</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“RGB-D相机”</gydF4y2Baspan><span class="n">O3D_NORMALS_K_SIZE</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="n">O3D_MESH_POISSON_DEPTH</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">9</gydF4y2Baspan><span class="n">O3D_MESH_DENSITIES_QUANTILE</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mf">0.05</gydF4y2Baspan><span class="n">O3D_DISPLAY_POINTS</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="n">O3D_DISPLAY_WIREFRAME</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="c1">#----------------------------------</gydF4y2Baspan><span class="c1">#从RoboDK获取模拟相机</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">CAMERA_NAME</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_CAMERA</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Cam2D_Add</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ActiveStation</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">CAMERA_NAME</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“开放”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------</gydF4y2Baspan><span class="c1">#检索相机设置/相机矩阵</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">settings_to_dict</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">设置</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">设置</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="p">{}</gydF4y2Baspan><span class="n">settings_dict</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">{}</gydF4y2Baspan><span class="n">settings_list</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">设置</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">分裂</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“=”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">设置</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">设置</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">带</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">分裂</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">' '</gydF4y2Baspan><span class="p">)]</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">设置</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">settings_list</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">设置</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">上</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">瓦尔</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">设置</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s1">“视场”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“PIXELSIZE”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“FOCAL_LENGTH”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“FAR_LENGTH”</gydF4y2Baspan><span class="p">]:</gydF4y2Baspan><span class="n">瓦尔</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">浮动</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">瓦尔</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">elif</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s1">“大小”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“ACTUALSIZE”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“快照”</gydF4y2Baspan><span class="p">]:</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">瓦尔</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">分裂</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“x”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">瓦尔</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="k">elif</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="n">瓦尔</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">上</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">瓦尔</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="c1">#国旗</gydF4y2Baspan><span class="n">settings_dict</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">瓦尔</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="n">settings_dict</gydF4y2Baspan><span class="n">cam_settings</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">settings_to_dict</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“设置”</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">cam_settings</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s1">“大小”</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">财政年度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">棕褐色</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">弧度</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">cam_settings</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s1">“视场”</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">cam_mtx</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">o3d</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">相机</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">PinholeCameraIntrinsic</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">宽度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">高度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">外汇</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">财政年度</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">财政年度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">财政年度</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">残雪</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">cy</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cam_pose</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">getLink</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">ITEM_TYPE_FRAME</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#获取深度图</gydF4y2Baspan><span class="c1">#方法1:通过socket(需要RoboDK v5.4.3-2022-06-20)</gydF4y2Baspan><span class="n">depth32_socket</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="n">bytes_img</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Cam2D_Snapshot</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">＂＂</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“深度”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="nb">isinstance</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">bytes_img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">字节</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="ow">而且</gydF4y2Baspan><span class="n">bytes_img</gydF4y2Baspan><span class="o">! =</gydF4y2Baspan><span class="sa">b</gydF4y2Baspan><span class="s1">”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#通过socket</gydF4y2Baspan><span class="n">depth32_socket</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">frombuffer</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">bytes_img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">dtype</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">> u4的</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">depth32_socket</gydF4y2Baspan><span class="p">[:</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">depth32_socket</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">flipud</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">重塑</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">depth32_socket</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">:,</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="p">）））</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">astype</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">uint32</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#方法2:从磁盘</gydF4y2Baspan><span class="n">depth32_disk</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="k">与</gydF4y2Baspan><span class="n">TemporaryDirectory</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">前缀</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“robodk_”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="n">道明</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">特遣部队</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">道明</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s1">' / temp.grey32 '</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Cam2D_Snapshot</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">特遣部队</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“深度”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">depth32_disk</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">fromfile</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">特遣部队</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">dtype</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">> u4的</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">depth32_disk</gydF4y2Baspan><span class="p">[:</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">depth32_disk</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">flipud</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">重塑</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">depth32_disk</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">:,</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="p">）））</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">astype</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">uint32</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#扩大规模</gydF4y2Baspan><span class="n">深度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">depth32_socket</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">iinfo</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">uint32</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">马克斯</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">cam_settings</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s1">“FAR_LENGTH”</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">深度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">深度</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">astype</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">float32</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#转换为点云，近似网格</gydF4y2Baspan><span class="n">纤毛运动</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">o3d</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">几何</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">PointCloud</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">create_from_depth_image</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">o3d</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">几何</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">深度</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="n">cam_mtx</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">纤毛运动</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">变换</gydF4y2Baspan><span class="p">([[</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">]]）</gydF4y2Baspan><span class="c1">与相机视图对齐</gydF4y2Baspan><span class="n">纤毛运动</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">estimate_normals</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">纤毛运动</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">orient_normals_consistent_tangent_plane</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">O3D_NORMALS_K_SIZE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">mesh_poisson</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">密度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">o3d</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">几何</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">TriangleMesh</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">create_from_point_cloud_poisson</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">纤毛运动</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">深度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">O3D_MESH_POISSON_DEPTH</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">vertices_to_remove</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">密度</gydF4y2Baspan><span class="o"><</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">分位数</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">密度</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">O3D_MESH_DENSITIES_QUANTILE</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">mesh_poisson</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">remove_vertices_by_mask</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">vertices_to_remove</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">mesh_poisson</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">paint_uniform_color</gydF4y2Baspan><span class="p">([</gydF4y2Baspan><span class="mf">0．5</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mf">0．5</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mf">0．5</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#向世界展示!</gydF4y2Baspan><span class="n">o3d</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">可视化</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">draw_geometries</gydF4y2Baspan><span class="p">([</gydF4y2Baspan><span class="n">纤毛运动</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">mesh_poisson</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">O3D_DISPLAY_POINTS</gydF4y2Baspan><span class="k">其他的</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">mesh_poisson</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="n">mesh_show_back_face</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">mesh_show_wireframe</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">O3D_DISPLAY_WIREFRAME</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#将网格导入RoboDK</gydF4y2Baspan><span class="k">与</gydF4y2Baspan><span class="n">TemporaryDirectory</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">前缀</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“robodk_”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="n">道明</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">特遣部队</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">道明</gydF4y2Baspan><span class="o">+</gydF4y2Baspan><span class="s1">' / mesh.ply '</gydF4y2Baspan><span class="n">o3d</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">io</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">write_triangle_mesh</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">特遣部队</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">mesh_poisson</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">write_ascii</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">mesh_item</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">AddFile</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">特遣部队</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">mesh_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">cam_pose</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">robomath</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">rotx</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">robomath</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">π</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">mesh_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">改变颜色</gydF4y2Baspan><span class="p">([</gydF4y2Baspan><span class="mf">0．5</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mf">0．5</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mf">0．5</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="n">mesh_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“重建网格”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan></pre> </div> </div> </div> </div> <div class="section" id="rgb-d-livestream"> <h3><span class="section-number">6.36.3.</gydF4y2Baspan>RGB-D转播画面<一个class="headerlink" href="#rgb-d-livestream" title="¶＂>gydF4y2Ba¶</一个></h3.><p>这个例子展示了如何使用Open3D在3D中可视化RGB-D摄像机。使用Stanford Bunny和RoboDK模拟摄像机，您可以提取32位深度图，将其转换为点云，并在3D查看器中可视化。</p><一个class="reference internal image-reference" href="//m.sinclairbody.com/doc/en/PythonAPI/_images/RGBDCameraOpen3D.png"><img alt="_images / RGBDCameraOpen3D.png＂class="align-center" src="//m.sinclairbody.com/doc/en/PythonAPI/_images/RGBDCameraOpen3D.png" style="width: 60%;"></a> <div class="literal-block-wrapper docutils container" id="id14"> <div class="code-block-caption"> <span class="caption-text">RGB-D转播画面</gydF4y2Baspan> <a class="headerlink" href="#id14" title="¶＂>gydF4y2Ba¶</一个></div> <div class="highlight-default notranslate"> <div class="highlight"> <pre><span></span><span class="c1">输入help("robolink")或help("robodk")查看更多信息</gydF4y2Baspan><span class="c1">#按F5运行脚本</gydF4y2Baspan><span class="c1">#文档://m.sinclairbody.com/doc/en/RoboDK-API.html</gydF4y2Baspan><span class="c1">#参考://m.sinclairbody.com/doc/en/PythonAPI/index.html</gydF4y2Baspan><span class="c1">＃</gydF4y2Baspan><span class="c1">这个例子展示了如何检索RGB和Depth图像，以使用模拟相机在3D中可视化彩色点云。</gydF4y2Baspan><span class="c1">#它使用Open3D将深度图转换为点云并进行可视化。</gydF4y2Baspan><span class="c1">左键单击视图，在查看器中移动网格。</gydF4y2Baspan><span class="kn">从</gydF4y2Baspan><span class="nn">robodk.robolink</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">numpy</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="nn">np</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">open3d</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="nn">o3d</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">cv2</gydF4y2Baspan><span class="k">作为</gydF4y2Baspan><span class="nn">简历</gydF4y2Baspan><span class="c1">#----------------------------------</gydF4y2Baspan><span class="c1">#你可能需要根据对象/设置来进行这些设置</gydF4y2Baspan><span class="n">CAMERA_NAME</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">“RGB-D相机”</gydF4y2Baspan><span class="n">ANIMATE_OBJECT</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="c1">#----------------------------------</gydF4y2Baspan><span class="c1">#从RoboDK获取模拟相机</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">Robolink</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">项</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">CAMERA_NAME</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">ITEM_TYPE_CAMERA</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Cam2D_Add</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ActiveStation</gydF4y2Baspan><span class="p">（))</gydF4y2Baspan><span class="c1">不要在这里设置DEPTH选项，因为我们正在检索RGB和DEPTH图像</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setName</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">CAMERA_NAME</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“开放”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------</gydF4y2Baspan><span class="c1">#获取扫描对象，旋转它</gydF4y2Baspan><span class="n">obj_item</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">ItemUserPick</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">itemtype_or_list</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">ITEM_TYPE_OBJECT</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">obj_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">有效的</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">obj_item</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="c1">#----------------------------------</gydF4y2Baspan><span class="c1">#检索相机设置/相机矩阵</gydF4y2Baspan><span class="k">def</gydF4y2Baspan><span class="nf">settings_to_dict</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">设置</gydF4y2Baspan><span class="p">)：</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">设置</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="p">{}</gydF4y2Baspan><span class="n">settings_dict</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">{}</gydF4y2Baspan><span class="n">settings_list</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">设置</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">分裂</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“=”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">设置</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">设置</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">带</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">分裂</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">' '</gydF4y2Baspan><span class="p">)]</gydF4y2Baspan><span class="k">为</gydF4y2Baspan><span class="n">设置</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="n">settings_list</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">设置</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">上</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">瓦尔</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">设置</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s1">“视场”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“PIXELSIZE”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“FOCAL_LENGTH”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“FAR_LENGTH”</gydF4y2Baspan><span class="p">]:</gydF4y2Baspan><span class="n">瓦尔</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="nb">浮动</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">瓦尔</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">elif</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="ow">在</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s1">“大小”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“ACTUALSIZE”</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“快照”</gydF4y2Baspan><span class="p">]:</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">瓦尔</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">分裂</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“x”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">瓦尔</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="nb">int</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="k">elif</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="n">瓦尔</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">上</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="n">瓦尔</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="c1">#国旗</gydF4y2Baspan><span class="n">settings_dict</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="n">关键</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">瓦尔</gydF4y2Baspan><span class="k">返回</gydF4y2Baspan><span class="n">settings_dict</gydF4y2Baspan><span class="n">cam_settings</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">settings_to_dict</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setParam</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s1">“设置”</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">cam_settings</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s1">“大小”</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">财政年度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">棕褐色</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">弧度</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">cam_settings</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s1">“视场”</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="n">cam_params</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">o3d</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">相机</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">PinholeCameraParameters</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">cam_params</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">内在</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">o3d</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">相机</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">PinholeCameraIntrinsic</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">宽度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">高度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">外汇</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">财政年度</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">财政年度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">财政年度</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">残雪</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">cy</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------</gydF4y2Baspan><span class="c1">#初始化一个非阻塞3D查看器</gydF4y2Baspan><span class="n">力</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">o3d</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">可视化</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">视觉型的人</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="n">力</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">create_window</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">“RoboDK RGB-D Viewer”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">源</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="k">而</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#从RoboDK获取RDB+D图像</gydF4y2Baspan><span class="c1">#获取RGB图像</gydF4y2Baspan><span class="n">rgb</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="n">bytes_img</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Cam2D_Snapshot</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">＂＂</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="nb">isinstance</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">bytes_img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">字节</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">bytes_img</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="sa">b</gydF4y2Baspan><span class="s1">”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">继续</gydF4y2Baspan><span class="n">nparr</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">frombuffer</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">bytes_img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">uint8</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">rgb</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">imdecode</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">nparr</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">IMREAD_ANYCOLOR</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">rgb</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">cvtColor</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">rgb</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">简历</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">COLOR_RGB2BGR</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#获取深度图像</gydF4y2Baspan><span class="n">depth32</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="n">bytes_img</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">RDK</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">Cam2D_Snapshot</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="s2">＂＂</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">cam_item</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="s1">“深度”</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="nb">isinstance</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">bytes_img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="nb">字节</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="ow">或</gydF4y2Baspan><span class="n">bytes_img</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="sa">b</gydF4y2Baspan><span class="s1">”</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="k">继续</gydF4y2Baspan><span class="n">depth32</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">frombuffer</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">bytes_img</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">dtype</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="s1">> u4的</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">depth32</gydF4y2Baspan><span class="p">[:</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">depth32</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">flipud</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">重塑</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">depth32</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">2</gydF4y2Baspan><span class="p">:,</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">h</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">w</gydF4y2Baspan><span class="p">）））</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">astype</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">uint32</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">深度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">depth32</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">iinfo</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">uint32</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">马克斯</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">cam_settings</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="s1">“FAR_LENGTH”</gydF4y2Baspan><span class="p">］</gydF4y2Baspan><span class="n">深度</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">深度</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">astype</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">np</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">float32</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">rgbd_image</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">o3d</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">几何</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">RGBDImage</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">create_from_color_and_depth</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">o3d</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">几何</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">rgb</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="n">o3d</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">几何</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">图像</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">深度</gydF4y2Baspan><span class="p">)，</gydF4y2Baspan><span class="n">convert_rgb_to_intensity</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">假</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#转换为点云</gydF4y2Baspan><span class="n">纤毛运动</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">o3d</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">几何</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">PointCloud</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">create_from_rgbd_image</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">rgbd_image</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">cam_params</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">内在</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">纤毛运动</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">变换</gydF4y2Baspan><span class="p">([[</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="o">-</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">),</gydF4y2Baspan><span class="p">［</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">]]）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#更新查看器</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">源</gydF4y2Baspan><span class="ow">是</gydF4y2Baspan><span class="kc">没有一个</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">源</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">纤毛运动</gydF4y2Baspan><span class="k">其他的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">源</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">纤毛运动</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">点</gydF4y2Baspan><span class="n">源</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">颜色</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">纤毛运动</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">颜色</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">= =</gydF4y2Baspan><span class="mi">0</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">力</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">add_geometry</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">源</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">reset_bounding_box</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="kc">真正的</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">其他的</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">力</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">update_geometry</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">源</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="ow">不</gydF4y2Baspan><span class="n">力</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">poll_events</gydF4y2Baspan><span class="p">（）：</gydF4y2Baspan><span class="k">打破</gydF4y2Baspan><span class="n">力</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">update_renderer</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="c1">#----------------------------------------------</gydF4y2Baspan><span class="c1">#彩虹颜色循环和旋转对象</gydF4y2Baspan><span class="k">如果</gydF4y2Baspan><span class="n">ANIMATE_OBJECT</gydF4y2Baspan><span class="ow">而且</gydF4y2Baspan><span class="n">obj_item</gydF4y2Baspan><span class="p">：</gydF4y2Baspan><span class="n">obj_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">setPose</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">obj_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">构成</gydF4y2Baspan><span class="p">（）</gydF4y2Baspan><span class="o">＊</gydF4y2Baspan><span class="n">robomath</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">rotz</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="mf">0.05</gydF4y2Baspan><span class="p">）)</gydF4y2Baspan><span class="kn">进口</gydF4y2Baspan><span class="nn">colorsys</gydF4y2Baspan><span class="n">r</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">g</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">b</gydF4y2Baspan><span class="o">＝</gydF4y2Baspan><span class="n">colorsys</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">hsv_to_rgb</gydF4y2Baspan><span class="p">（</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">％</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="o">/</gydF4y2Baspan><span class="mi">One hundred.</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">）</gydF4y2Baspan><span class="n">obj_item</gydF4y2Baspan><span class="o">．</gydF4y2Baspan><span class="n">改变颜色</gydF4y2Baspan><span class="p">([</gydF4y2Baspan><span class="n">r</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">g</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="n">b</gydF4y2Baspan><span class="p">，</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan><span class="p">])</gydF4y2Baspan><span class="n">我</gydF4y2Baspan><span class="o">+ =</gydF4y2Baspan><span class="mi">1</gydF4y2Baspan></pre> </div> </div> </div> </div> </div> </div> </div> </div> <footer> <div class="rst-footer-buttons" role="navigation" aria-label="footer navigation"> <a href="//m.sinclairbody.com/doc/en/PythonAPI/app.html" class="btn btn-neutral float-left" title="以前的＂一个ccesskey="p" rel="prev"><span class="fa fa-arrow-circle-left" aria-hidden="true"></span>以前的</一个></div> <hr> <div role="contentinfo"> <p>©版权所有2015-2022,RoboDK。</p></gydF4y2Badiv>建立与<一个href="https://www.sphinx-doc.org/">斯芬克斯</一个>使用一个<一个href="https://github.com/readthedocs/sphinx_rtd_theme">主题</一个>所提供的<一个href="https://readthedocs.org">阅读文档</一个>．</fgydF4y2Baooter> </div> </div> </section> </div> </body> </html>