mirror of https://github.com/koide3/small_gicp.git
156 lines
18 KiB
HTML
156 lines
18 KiB
HTML
<!DOCTYPE html PUBLIC "-//W3C//DTD XHTML 1.0 Transitional//EN" "https://www.w3.org/TR/xhtml1/DTD/xhtml1-transitional.dtd">
|
|
<html xmlns="http://www.w3.org/1999/xhtml">
|
|
<head>
|
|
<meta http-equiv="Content-Type" content="text/xhtml;charset=UTF-8"/>
|
|
<meta http-equiv="X-UA-Compatible" content="IE=9"/>
|
|
<meta name="generator" content="Doxygen 1.9.1"/>
|
|
<meta name="viewport" content="width=device-width, initial-scale=1"/>
|
|
<title>small_gicp: /home/runner/work/small_gicp/small_gicp/include/small_gicp/registration/reduction_omp.hpp Source File</title>
|
|
<link href="tabs.css" rel="stylesheet" type="text/css"/>
|
|
<script type="text/javascript" src="jquery.js"></script>
|
|
<script type="text/javascript" src="dynsections.js"></script>
|
|
<link href="search/search.css" rel="stylesheet" type="text/css"/>
|
|
<script type="text/javascript" src="search/searchdata.js"></script>
|
|
<script type="text/javascript" src="search/search.js"></script>
|
|
<link href="doxygen.css" rel="stylesheet" type="text/css" />
|
|
</head>
|
|
<body>
|
|
<div id="top"><!-- do not remove this div, it is closed by doxygen! -->
|
|
<div id="titlearea">
|
|
<table cellspacing="0" cellpadding="0">
|
|
<tbody>
|
|
<tr style="height: 56px;">
|
|
<td id="projectalign" style="padding-left: 0.5em;">
|
|
<div id="projectname">small_gicp
|
|
</div>
|
|
</td>
|
|
</tr>
|
|
</tbody>
|
|
</table>
|
|
</div>
|
|
<!-- end header part -->
|
|
<!-- Generated by Doxygen 1.9.1 -->
|
|
<script type="text/javascript">
|
|
/* @license magnet:?xt=urn:btih:cf05388f2679ee054f2beb29a391d25f4e673ac3&dn=gpl-2.0.txt GPL-v2 */
|
|
var searchBox = new SearchBox("searchBox", "search",false,'Search','.html');
|
|
/* @license-end */
|
|
</script>
|
|
<script type="text/javascript" src="menudata.js"></script>
|
|
<script type="text/javascript" src="menu.js"></script>
|
|
<script type="text/javascript">
|
|
/* @license magnet:?xt=urn:btih:cf05388f2679ee054f2beb29a391d25f4e673ac3&dn=gpl-2.0.txt GPL-v2 */
|
|
$(function() {
|
|
initMenu('',true,false,'search.php','Search');
|
|
$(document).ready(function() { init_search(); });
|
|
});
|
|
/* @license-end */</script>
|
|
<div id="main-nav"></div>
|
|
<!-- window showing the filter options -->
|
|
<div id="MSearchSelectWindow"
|
|
onmouseover="return searchBox.OnSearchSelectShow()"
|
|
onmouseout="return searchBox.OnSearchSelectHide()"
|
|
onkeydown="return searchBox.OnSearchSelectKey(event)">
|
|
</div>
|
|
|
|
<!-- iframe showing the search results (closed by default) -->
|
|
<div id="MSearchResultsWindow">
|
|
<iframe src="javascript:void(0)" frameborder="0"
|
|
name="MSearchResults" id="MSearchResults">
|
|
</iframe>
|
|
</div>
|
|
|
|
<div id="nav-path" class="navpath">
|
|
<ul>
|
|
<li class="navelem"><a class="el" href="dir_d44c64559bbebec7f509842c48db8b23.html">include</a></li><li class="navelem"><a class="el" href="dir_8f93768a68ffc2367e7100c40b4e616a.html">small_gicp</a></li><li class="navelem"><a class="el" href="dir_b9dd3af08b5360c2148fef90713dd643.html">registration</a></li> </ul>
|
|
</div>
|
|
</div><!-- top -->
|
|
<div class="header">
|
|
<div class="headertitle">
|
|
<div class="title">reduction_omp.hpp</div> </div>
|
|
</div><!--header-->
|
|
<div class="contents">
|
|
<a href="reduction__omp_8hpp.html">Go to the documentation of this file.</a><div class="fragment"><div class="line"><a name="l00001"></a><span class="lineno"> 1</span> <span class="comment">// SPDX-FileCopyrightText: Copyright 2024 Kenji Koide</span></div>
|
|
<div class="line"><a name="l00002"></a><span class="lineno"> 2</span> <span class="comment">// SPDX-License-Identifier: MIT</span></div>
|
|
<div class="line"><a name="l00003"></a><span class="lineno"> 3</span> <span class="preprocessor">#pragma once</span></div>
|
|
<div class="line"><a name="l00004"></a><span class="lineno"> 4</span>  </div>
|
|
<div class="line"><a name="l00005"></a><span class="lineno"> 5</span> <span class="preprocessor">#include <Eigen/Core></span></div>
|
|
<div class="line"><a name="l00006"></a><span class="lineno"> 6</span>  </div>
|
|
<div class="line"><a name="l00007"></a><span class="lineno"> 7</span> <span class="keyword">namespace </span><a class="code" href="namespacesmall__gicp.html">small_gicp</a> {</div>
|
|
<div class="line"><a name="l00008"></a><span class="lineno"> 8</span>  </div>
|
|
<div class="line"><a name="l00009"></a><span class="lineno"> 9</span> <span class="preprocessor">#ifndef _OPENMP</span></div>
|
|
<div class="line"><a name="l00010"></a><span class="lineno"> 10</span> <span class="preprocessor">#warning "OpenMP is not available. Parallel reduction will be disabled."</span></div>
|
|
<div class="line"><a name="l00011"></a><span class="lineno"><a class="line" href="namespacesmall__gicp.html#ae507f2dc845993bd13809aa91b2a48bf"> 11</a></span> <span class="keyword">inline</span> <span class="keywordtype">int</span> <a class="code" href="namespacesmall__gicp.html#ae507f2dc845993bd13809aa91b2a48bf">omp_get_thread_num</a>() {</div>
|
|
<div class="line"><a name="l00012"></a><span class="lineno"> 12</span>  <span class="keywordflow">return</span> 0;</div>
|
|
<div class="line"><a name="l00013"></a><span class="lineno"> 13</span> }</div>
|
|
<div class="line"><a name="l00014"></a><span class="lineno"> 14</span> <span class="preprocessor">#endif</span></div>
|
|
<div class="line"><a name="l00015"></a><span class="lineno"> 15</span>  </div>
|
|
<div class="line"><a name="l00017"></a><span class="lineno"><a class="line" href="structsmall__gicp_1_1ParallelReductionOMP.html"> 17</a></span> <span class="keyword">struct </span><a class="code" href="structsmall__gicp_1_1ParallelReductionOMP.html">ParallelReductionOMP</a> {</div>
|
|
<div class="line"><a name="l00018"></a><span class="lineno"><a class="line" href="structsmall__gicp_1_1ParallelReductionOMP.html#ab027c61efa28990e0f948ce3ef6dbdde"> 18</a></span>  <a class="code" href="structsmall__gicp_1_1ParallelReductionOMP.html#ab027c61efa28990e0f948ce3ef6dbdde">ParallelReductionOMP</a>() : <a class="code" href="structsmall__gicp_1_1ParallelReductionOMP.html#a26dc4c1e94e861e4c3022eae3c04e5c1">num_threads</a>(4) {}</div>
|
|
<div class="line"><a name="l00019"></a><span class="lineno"> 19</span>  </div>
|
|
<div class="line"><a name="l00020"></a><span class="lineno"> 20</span>  <span class="keyword">template</span> <<span class="keyword">typename</span> TargetPo<span class="keywordtype">int</span>Cloud, <span class="keyword">typename</span> SourcePo<span class="keywordtype">int</span>Cloud, <span class="keyword">typename</span> TargetTree, <span class="keyword">typename</span> CorrespondenceRejector, <span class="keyword">typename</span> Factor></div>
|
|
<div class="line"><a name="l00021"></a><span class="lineno"><a class="line" href="structsmall__gicp_1_1ParallelReductionOMP.html#afbac34ebae0aa17db6cfa7042363c815"> 21</a></span>  std::tuple<Eigen::Matrix<double, 6, 6>, Eigen::Matrix<double, 6, 1>, <span class="keywordtype">double</span>> <a class="code" href="structsmall__gicp_1_1ParallelReductionOMP.html#afbac34ebae0aa17db6cfa7042363c815">linearize</a>(</div>
|
|
<div class="line"><a name="l00022"></a><span class="lineno"> 22</span>  <span class="keyword">const</span> TargetPointCloud& target,</div>
|
|
<div class="line"><a name="l00023"></a><span class="lineno"> 23</span>  <span class="keyword">const</span> SourcePointCloud& source,</div>
|
|
<div class="line"><a name="l00024"></a><span class="lineno"> 24</span>  <span class="keyword">const</span> TargetTree& target_tree,</div>
|
|
<div class="line"><a name="l00025"></a><span class="lineno"> 25</span>  <span class="keyword">const</span> CorrespondenceRejector& rejector,</div>
|
|
<div class="line"><a name="l00026"></a><span class="lineno"> 26</span>  <span class="keyword">const</span> Eigen::Isometry3d& T,</div>
|
|
<div class="line"><a name="l00027"></a><span class="lineno"> 27</span>  std::vector<Factor>& factors)<span class="keyword"> const </span>{</div>
|
|
<div class="line"><a name="l00028"></a><span class="lineno"> 28</span>  std::vector<Eigen::Matrix<double, 6, 6>> Hs(<a class="code" href="structsmall__gicp_1_1ParallelReductionOMP.html#a26dc4c1e94e861e4c3022eae3c04e5c1">num_threads</a>, Eigen::Matrix<double, 6, 6>::Zero());</div>
|
|
<div class="line"><a name="l00029"></a><span class="lineno"> 29</span>  std::vector<Eigen::Matrix<double, 6, 1>> bs(<a class="code" href="structsmall__gicp_1_1ParallelReductionOMP.html#a26dc4c1e94e861e4c3022eae3c04e5c1">num_threads</a>, Eigen::Matrix<double, 6, 1>::Zero());</div>
|
|
<div class="line"><a name="l00030"></a><span class="lineno"> 30</span>  std::vector<double> es(<a class="code" href="structsmall__gicp_1_1ParallelReductionOMP.html#a26dc4c1e94e861e4c3022eae3c04e5c1">num_threads</a>, 0.0);</div>
|
|
<div class="line"><a name="l00031"></a><span class="lineno"> 31</span>  </div>
|
|
<div class="line"><a name="l00032"></a><span class="lineno"> 32</span> <span class="preprocessor">#pragma omp parallel for num_threads(num_threads) schedule(guided, 8)</span></div>
|
|
<div class="line"><a name="l00033"></a><span class="lineno"> 33</span>  <span class="keywordflow">for</span> (std::int64_t i = 0; i < factors.size(); i++) {</div>
|
|
<div class="line"><a name="l00034"></a><span class="lineno"> 34</span>  Eigen::Matrix<double, 6, 6> H;</div>
|
|
<div class="line"><a name="l00035"></a><span class="lineno"> 35</span>  Eigen::Matrix<double, 6, 1> b;</div>
|
|
<div class="line"><a name="l00036"></a><span class="lineno"> 36</span>  <span class="keywordtype">double</span> e;</div>
|
|
<div class="line"><a name="l00037"></a><span class="lineno"> 37</span>  </div>
|
|
<div class="line"><a name="l00038"></a><span class="lineno"> 38</span>  <span class="keywordflow">if</span> (!factors[i].<a class="code" href="structsmall__gicp_1_1ParallelReductionOMP.html#afbac34ebae0aa17db6cfa7042363c815">linearize</a>(target, source, target_tree, T, i, rejector, &H, &b, &e)) {</div>
|
|
<div class="line"><a name="l00039"></a><span class="lineno"> 39</span>  <span class="keywordflow">continue</span>;</div>
|
|
<div class="line"><a name="l00040"></a><span class="lineno"> 40</span>  }</div>
|
|
<div class="line"><a name="l00041"></a><span class="lineno"> 41</span>  </div>
|
|
<div class="line"><a name="l00042"></a><span class="lineno"> 42</span>  <span class="keyword">const</span> <span class="keywordtype">int</span> thread_id = <a class="code" href="namespacesmall__gicp.html#ae507f2dc845993bd13809aa91b2a48bf">omp_get_thread_num</a>();</div>
|
|
<div class="line"><a name="l00043"></a><span class="lineno"> 43</span>  Hs[thread_id] += H;</div>
|
|
<div class="line"><a name="l00044"></a><span class="lineno"> 44</span>  bs[thread_id] += b;</div>
|
|
<div class="line"><a name="l00045"></a><span class="lineno"> 45</span>  es[thread_id] += e;</div>
|
|
<div class="line"><a name="l00046"></a><span class="lineno"> 46</span>  }</div>
|
|
<div class="line"><a name="l00047"></a><span class="lineno"> 47</span>  </div>
|
|
<div class="line"><a name="l00048"></a><span class="lineno"> 48</span>  <span class="keywordflow">for</span> (<span class="keywordtype">int</span> i = 1; i < <a class="code" href="structsmall__gicp_1_1ParallelReductionOMP.html#a26dc4c1e94e861e4c3022eae3c04e5c1">num_threads</a>; i++) {</div>
|
|
<div class="line"><a name="l00049"></a><span class="lineno"> 49</span>  Hs[0] += Hs[i];</div>
|
|
<div class="line"><a name="l00050"></a><span class="lineno"> 50</span>  bs[0] += bs[i];</div>
|
|
<div class="line"><a name="l00051"></a><span class="lineno"> 51</span>  es[0] += es[i];</div>
|
|
<div class="line"><a name="l00052"></a><span class="lineno"> 52</span>  }</div>
|
|
<div class="line"><a name="l00053"></a><span class="lineno"> 53</span>  </div>
|
|
<div class="line"><a name="l00054"></a><span class="lineno"> 54</span>  <span class="keywordflow">return</span> {Hs[0], bs[0], es[0]};</div>
|
|
<div class="line"><a name="l00055"></a><span class="lineno"> 55</span>  }</div>
|
|
<div class="line"><a name="l00056"></a><span class="lineno"> 56</span>  </div>
|
|
<div class="line"><a name="l00057"></a><span class="lineno"> 57</span>  <span class="keyword">template</span> <<span class="keyword">typename</span> TargetPo<span class="keywordtype">int</span>Cloud, <span class="keyword">typename</span> SourcePo<span class="keywordtype">int</span>Cloud, <span class="keyword">typename</span> Factor></div>
|
|
<div class="line"><a name="l00058"></a><span class="lineno"><a class="line" href="structsmall__gicp_1_1ParallelReductionOMP.html#a264cb8bb8760197f69938522fa393a69"> 58</a></span>  <span class="keywordtype">double</span> <a class="code" href="structsmall__gicp_1_1ParallelReductionOMP.html#a264cb8bb8760197f69938522fa393a69">error</a>(<span class="keyword">const</span> TargetPointCloud& target, <span class="keyword">const</span> SourcePointCloud& source, <span class="keyword">const</span> Eigen::Isometry3d& T, std::vector<Factor>& factors)<span class="keyword"> const </span>{</div>
|
|
<div class="line"><a name="l00059"></a><span class="lineno"> 59</span>  <span class="keywordtype">double</span> sum_e = 0.0;</div>
|
|
<div class="line"><a name="l00060"></a><span class="lineno"> 60</span>  </div>
|
|
<div class="line"><a name="l00061"></a><span class="lineno"> 61</span> <span class="preprocessor">#pragma omp parallel for num_threads(num_threads) schedule(guided, 8) reduction(+ : sum_e)</span></div>
|
|
<div class="line"><a name="l00062"></a><span class="lineno"> 62</span>  <span class="keywordflow">for</span> (std::int64_t i = 0; i < factors.size(); i++) {</div>
|
|
<div class="line"><a name="l00063"></a><span class="lineno"> 63</span>  sum_e += factors[i].error(target, source, T);</div>
|
|
<div class="line"><a name="l00064"></a><span class="lineno"> 64</span>  }</div>
|
|
<div class="line"><a name="l00065"></a><span class="lineno"> 65</span>  <span class="keywordflow">return</span> sum_e;</div>
|
|
<div class="line"><a name="l00066"></a><span class="lineno"> 66</span>  }</div>
|
|
<div class="line"><a name="l00067"></a><span class="lineno"> 67</span>  </div>
|
|
<div class="line"><a name="l00068"></a><span class="lineno"><a class="line" href="structsmall__gicp_1_1ParallelReductionOMP.html#a26dc4c1e94e861e4c3022eae3c04e5c1"> 68</a></span>  <span class="keywordtype">int</span> <a class="code" href="structsmall__gicp_1_1ParallelReductionOMP.html#a26dc4c1e94e861e4c3022eae3c04e5c1">num_threads</a>; </div>
|
|
<div class="line"><a name="l00069"></a><span class="lineno"> 69</span> };</div>
|
|
<div class="line"><a name="l00070"></a><span class="lineno"> 70</span>  </div>
|
|
<div class="line"><a name="l00071"></a><span class="lineno"> 71</span> } <span class="comment">// namespace small_gicp</span></div>
|
|
<div class="ttc" id="anamespacesmall__gicp_html"><div class="ttname"><a href="namespacesmall__gicp.html">small_gicp</a></div><div class="ttdef"><b>Definition:</b> flat_container.hpp:12</div></div>
|
|
<div class="ttc" id="anamespacesmall__gicp_html_ae507f2dc845993bd13809aa91b2a48bf"><div class="ttname"><a href="namespacesmall__gicp.html#ae507f2dc845993bd13809aa91b2a48bf">small_gicp::omp_get_thread_num</a></div><div class="ttdeci">int omp_get_thread_num()</div><div class="ttdef"><b>Definition:</b> reduction_omp.hpp:11</div></div>
|
|
<div class="ttc" id="astructsmall__gicp_1_1ParallelReductionOMP_html"><div class="ttname"><a href="structsmall__gicp_1_1ParallelReductionOMP.html">small_gicp::ParallelReductionOMP</a></div><div class="ttdoc">Parallel reduction with OpenMP backend.</div><div class="ttdef"><b>Definition:</b> reduction_omp.hpp:17</div></div>
|
|
<div class="ttc" id="astructsmall__gicp_1_1ParallelReductionOMP_html_a264cb8bb8760197f69938522fa393a69"><div class="ttname"><a href="structsmall__gicp_1_1ParallelReductionOMP.html#a264cb8bb8760197f69938522fa393a69">small_gicp::ParallelReductionOMP::error</a></div><div class="ttdeci">double error(const TargetPointCloud &target, const SourcePointCloud &source, const Eigen::Isometry3d &T, std::vector< Factor > &factors) const</div><div class="ttdef"><b>Definition:</b> reduction_omp.hpp:58</div></div>
|
|
<div class="ttc" id="astructsmall__gicp_1_1ParallelReductionOMP_html_a26dc4c1e94e861e4c3022eae3c04e5c1"><div class="ttname"><a href="structsmall__gicp_1_1ParallelReductionOMP.html#a26dc4c1e94e861e4c3022eae3c04e5c1">small_gicp::ParallelReductionOMP::num_threads</a></div><div class="ttdeci">int num_threads</div><div class="ttdoc">Number of threads.</div><div class="ttdef"><b>Definition:</b> reduction_omp.hpp:68</div></div>
|
|
<div class="ttc" id="astructsmall__gicp_1_1ParallelReductionOMP_html_ab027c61efa28990e0f948ce3ef6dbdde"><div class="ttname"><a href="structsmall__gicp_1_1ParallelReductionOMP.html#ab027c61efa28990e0f948ce3ef6dbdde">small_gicp::ParallelReductionOMP::ParallelReductionOMP</a></div><div class="ttdeci">ParallelReductionOMP()</div><div class="ttdef"><b>Definition:</b> reduction_omp.hpp:18</div></div>
|
|
<div class="ttc" id="astructsmall__gicp_1_1ParallelReductionOMP_html_afbac34ebae0aa17db6cfa7042363c815"><div class="ttname"><a href="structsmall__gicp_1_1ParallelReductionOMP.html#afbac34ebae0aa17db6cfa7042363c815">small_gicp::ParallelReductionOMP::linearize</a></div><div class="ttdeci">std::tuple< Eigen::Matrix< double, 6, 6 >, Eigen::Matrix< double, 6, 1 >, double > linearize(const TargetPointCloud &target, const SourcePointCloud &source, const TargetTree &target_tree, const CorrespondenceRejector &rejector, const Eigen::Isometry3d &T, std::vector< Factor > &factors) const</div><div class="ttdef"><b>Definition:</b> reduction_omp.hpp:21</div></div>
|
|
</div><!-- fragment --></div><!-- contents -->
|
|
<!-- start footer part -->
|
|
<hr class="footer"/><address class="footer"><small>
|
|
Generated by <a href="https://www.doxygen.org/index.html"><img class="footer" src="doxygen.svg" width="104" height="31" alt="doxygen"/></a> 1.9.1
|
|
</small></address>
|
|
</body>
|
|
</html>
|