| <a href="_n_e_harris_corners_kernel_8cpp.xhtml">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">/*</span></div><div class="line"><a name="l00002"></a><span class="lineno"> 2</span> <span class="comment"> * Copyright (c) 2016-2019 ARM Limited.</span></div><div class="line"><a name="l00003"></a><span class="lineno"> 3</span> <span class="comment"> *</span></div><div class="line"><a name="l00004"></a><span class="lineno"> 4</span> <span class="comment"> * SPDX-License-Identifier: MIT</span></div><div class="line"><a name="l00005"></a><span class="lineno"> 5</span> <span class="comment"> *</span></div><div class="line"><a name="l00006"></a><span class="lineno"> 6</span> <span class="comment"> * Permission is hereby granted, free of charge, to any person obtaining a copy</span></div><div class="line"><a name="l00007"></a><span class="lineno"> 7</span> <span class="comment"> * of this software and associated documentation files (the "Software"), to</span></div><div class="line"><a name="l00008"></a><span class="lineno"> 8</span> <span class="comment"> * deal in the Software without restriction, including without limitation the</span></div><div class="line"><a name="l00009"></a><span class="lineno"> 9</span> <span class="comment"> * rights to use, copy, modify, merge, publish, distribute, sublicense, and/or</span></div><div class="line"><a name="l00010"></a><span class="lineno"> 10</span> <span class="comment"> * sell copies of the Software, and to permit persons to whom the Software is</span></div><div class="line"><a name="l00011"></a><span class="lineno"> 11</span> <span class="comment"> * furnished to do so, subject to the following conditions:</span></div><div class="line"><a name="l00012"></a><span class="lineno"> 12</span> <span class="comment"> *</span></div><div class="line"><a name="l00013"></a><span class="lineno"> 13</span> <span class="comment"> * The above copyright notice and this permission notice shall be included in all</span></div><div class="line"><a name="l00014"></a><span class="lineno"> 14</span> <span class="comment"> * copies or substantial portions of the Software.</span></div><div class="line"><a name="l00015"></a><span class="lineno"> 15</span> <span class="comment"> *</span></div><div class="line"><a name="l00016"></a><span class="lineno"> 16</span> <span class="comment"> * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR</span></div><div class="line"><a name="l00017"></a><span class="lineno"> 17</span> <span class="comment"> * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,</span></div><div class="line"><a name="l00018"></a><span class="lineno"> 18</span> <span class="comment"> * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE</span></div><div class="line"><a name="l00019"></a><span class="lineno"> 19</span> <span class="comment"> * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER</span></div><div class="line"><a name="l00020"></a><span class="lineno"> 20</span> <span class="comment"> * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,</span></div><div class="line"><a name="l00021"></a><span class="lineno"> 21</span> <span class="comment"> * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE</span></div><div class="line"><a name="l00022"></a><span class="lineno"> 22</span> <span class="comment"> * SOFTWARE.</span></div><div class="line"><a name="l00023"></a><span class="lineno"> 23</span> <span class="comment"> */</span></div><div class="line"><a name="l00024"></a><span class="lineno"> 24</span> <span class="preprocessor">#include "<a class="code" href="_n_e_harris_corners_kernel_8h.xhtml">arm_compute/core/NEON/kernels/NEHarrisCornersKernel.h</a>"</span></div><div class="line"><a name="l00025"></a><span class="lineno"> 25</span> </div><div class="line"><a name="l00026"></a><span class="lineno"> 26</span> <span class="preprocessor">#include "<a class="code" href="_coordinates_8h.xhtml">arm_compute/core/Coordinates.h</a>"</span></div><div class="line"><a name="l00027"></a><span class="lineno"> 27</span> <span class="preprocessor">#include "<a class="code" href="_error_8h.xhtml">arm_compute/core/Error.h</a>"</span></div><div class="line"><a name="l00028"></a><span class="lineno"> 28</span> <span class="preprocessor">#include "<a class="code" href="arm__compute_2core_2_helpers_8h.xhtml">arm_compute/core/Helpers.h</a>"</span></div><div class="line"><a name="l00029"></a><span class="lineno"> 29</span> <span class="preprocessor">#include "<a class="code" href="_tensor_info_8h.xhtml">arm_compute/core/TensorInfo.h</a>"</span></div><div class="line"><a name="l00030"></a><span class="lineno"> 30</span> <span class="preprocessor">#include "<a class="code" href="arm__compute_2core_2_types_8h.xhtml">arm_compute/core/Types.h</a>"</span></div><div class="line"><a name="l00031"></a><span class="lineno"> 31</span> <span class="preprocessor">#include "<a class="code" href="arm__compute_2core_2_utils_8h.xhtml">arm_compute/core/Utils.h</a>"</span></div><div class="line"><a name="l00032"></a><span class="lineno"> 32</span> <span class="preprocessor">#include "<a class="code" href="_validate_8h.xhtml">arm_compute/core/Validate.h</a>"</span></div><div class="line"><a name="l00033"></a><span class="lineno"> 33</span> <span class="preprocessor">#include "<a class="code" href="_window_8h.xhtml">arm_compute/core/Window.h</a>"</span></div><div class="line"><a name="l00034"></a><span class="lineno"> 34</span> </div><div class="line"><a name="l00035"></a><span class="lineno"> 35</span> <span class="preprocessor">#include <algorithm></span></div><div class="line"><a name="l00036"></a><span class="lineno"> 36</span> <span class="preprocessor">#include <arm_neon.h></span></div><div class="line"><a name="l00037"></a><span class="lineno"> 37</span> <span class="preprocessor">#include <cmath></span></div><div class="line"><a name="l00038"></a><span class="lineno"> 38</span> <span class="preprocessor">#include <cstddef></span></div><div class="line"><a name="l00039"></a><span class="lineno"> 39</span> </div><div class="line"><a name="l00040"></a><span class="lineno"> 40</span> <span class="keyword">using namespace </span><a class="code" href="namespacearm__compute.xhtml">arm_compute</a>;</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">template</span> <span class="keyword">class </span><a class="code" href="classarm__compute_1_1_n_e_harris_score_kernel.xhtml">arm_compute::NEHarrisScoreKernel<3></a>;</div><div class="line"><a name="l00043"></a><span class="lineno"> 43</span> <span class="keyword">template</span> <span class="keyword">class </span><a class="code" href="classarm__compute_1_1_n_e_harris_score_kernel.xhtml">arm_compute::NEHarrisScoreKernel<5></a>;</div><div class="line"><a name="l00044"></a><span class="lineno"> 44</span> <span class="keyword">template</span> <span class="keyword">class </span><a class="code" href="classarm__compute_1_1_n_e_harris_score_kernel.xhtml">arm_compute::NEHarrisScoreKernel<7></a>;</div><div class="line"><a name="l00045"></a><span class="lineno"> 45</span> <span class="keyword">template</span> <a class="code" href="classarm__compute_1_1_n_e_harris_score_kernel.xhtml#a18cf8876acac9c6c2b35e38d9beabe9d">arm_compute::NEHarrisScoreKernel<3>::NEHarrisScoreKernel</a>();</div><div class="line"><a name="l00046"></a><span class="lineno"> 46</span> <span class="keyword">template</span> <a class="code" href="classarm__compute_1_1_n_e_harris_score_kernel.xhtml#a18cf8876acac9c6c2b35e38d9beabe9d">arm_compute::NEHarrisScoreKernel<5>::NEHarrisScoreKernel</a>();</div><div class="line"><a name="l00047"></a><span class="lineno"> 47</span> <span class="keyword">template</span> <a class="code" href="classarm__compute_1_1_n_e_harris_score_kernel.xhtml#a18cf8876acac9c6c2b35e38d9beabe9d">arm_compute::NEHarrisScoreKernel<7>::NEHarrisScoreKernel</a>();</div><div class="line"><a name="l00048"></a><span class="lineno"> 48</span> </div><div class="line"><a name="l00049"></a><span class="lineno"> 49</span> <span class="keyword">namespace</span></div><div class="line"><a name="l00050"></a><span class="lineno"> 50</span> {</div><div class="line"><a name="l00051"></a><span class="lineno"> 51</span> <span class="keyword">inline</span> float32x4_t harris_score(float32x4_t gx2, float32x4_t gy2, float32x4_t gxgy, float32x4_t sensitivity, float32x4_t strength_thresh)</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>  <span class="comment">// Trace^2</span></div><div class="line"><a name="l00054"></a><span class="lineno"> 54</span>  float32x4_t trace2 = vaddq_f32(gx2, gy2);</div><div class="line"><a name="l00055"></a><span class="lineno"> 55</span>  trace2 = vmulq_f32(trace2, trace2);</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="comment">// Det(A)</span></div><div class="line"><a name="l00058"></a><span class="lineno"> 58</span>  float32x4_t det = vmulq_f32(gx2, gy2);</div><div class="line"><a name="l00059"></a><span class="lineno"> 59</span>  det = vmlsq_f32(det, gxgy, gxgy);</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="comment">// Det(A) - sensitivity * trace^2</span></div><div class="line"><a name="l00062"></a><span class="lineno"> 62</span>  <span class="keyword">const</span> float32x4_t mc = vmlsq_f32(det, sensitivity, trace2);</div><div class="line"><a name="l00063"></a><span class="lineno"> 63</span> </div><div class="line"><a name="l00064"></a><span class="lineno"> 64</span>  <span class="comment">// mc > strength_thresh</span></div><div class="line"><a name="l00065"></a><span class="lineno"> 65</span>  <span class="keyword">const</span> uint32x4_t mask = vcgtq_f32(mc, strength_thresh);</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>  <span class="keywordflow">return</span> vbslq_f32(mask, mc, vdupq_n_f32(0.0f));</div><div class="line"><a name="l00068"></a><span class="lineno"> 68</span> }</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> <span class="keyword">inline</span> <span class="keywordtype">void</span> harris_score1x3_FLOAT_FLOAT_FLOAT(float32x4_t low_gx, float32x4_t low_gy, float32x4_t high_gx, float32x4_t high_gy, float32x4_t &gx2, float32x4_t &gy2, float32x4_t &gxgy,</div><div class="line"><a name="l00071"></a><span class="lineno"> 71</span>  float32x4_t norm_factor)</div><div class="line"><a name="l00072"></a><span class="lineno"> 72</span> {</div><div class="line"><a name="l00073"></a><span class="lineno"> 73</span>  <span class="comment">// Normalize</span></div><div class="line"><a name="l00074"></a><span class="lineno"> 74</span>  low_gx = vmulq_f32(low_gx, norm_factor);</div><div class="line"><a name="l00075"></a><span class="lineno"> 75</span>  low_gy = vmulq_f32(low_gy, norm_factor);</div><div class="line"><a name="l00076"></a><span class="lineno"> 76</span>  high_gx = vmulq_f32(high_gx, norm_factor);</div><div class="line"><a name="l00077"></a><span class="lineno"> 77</span>  high_gy = vmulq_f32(high_gy, norm_factor);</div><div class="line"><a name="l00078"></a><span class="lineno"> 78</span> </div><div class="line"><a name="l00079"></a><span class="lineno"> 79</span>  <span class="keyword">const</span> float32x4_t l_gx = low_gx;</div><div class="line"><a name="l00080"></a><span class="lineno"> 80</span>  <span class="keyword">const</span> float32x4_t l_gy = low_gy;</div><div class="line"><a name="l00081"></a><span class="lineno"> 81</span>  <span class="keyword">const</span> float32x4_t m_gx = vextq_f32(low_gx, high_gx, 1);</div><div class="line"><a name="l00082"></a><span class="lineno"> 82</span>  <span class="keyword">const</span> float32x4_t m_gy = vextq_f32(low_gy, high_gy, 1);</div><div class="line"><a name="l00083"></a><span class="lineno"> 83</span>  <span class="keyword">const</span> float32x4_t r_gx = vextq_f32(low_gx, high_gx, 2);</div><div class="line"><a name="l00084"></a><span class="lineno"> 84</span>  <span class="keyword">const</span> float32x4_t r_gy = vextq_f32(low_gy, high_gy, 2);</div><div class="line"><a name="l00085"></a><span class="lineno"> 85</span> </div><div class="line"><a name="l00086"></a><span class="lineno"> 86</span>  <span class="comment">// Gx*Gx</span></div><div class="line"><a name="l00087"></a><span class="lineno"> 87</span>  gx2 = vmlaq_f32(gx2, l_gx, l_gx);</div><div class="line"><a name="l00088"></a><span class="lineno"> 88</span>  gx2 = vmlaq_f32(gx2, m_gx, m_gx);</div><div class="line"><a name="l00089"></a><span class="lineno"> 89</span>  gx2 = vmlaq_f32(gx2, r_gx, r_gx);</div><div class="line"><a name="l00090"></a><span class="lineno"> 90</span> </div><div class="line"><a name="l00091"></a><span class="lineno"> 91</span>  <span class="comment">// Gy*Gy</span></div><div class="line"><a name="l00092"></a><span class="lineno"> 92</span>  gy2 = vmlaq_f32(gy2, l_gy, l_gy);</div><div class="line"><a name="l00093"></a><span class="lineno"> 93</span>  gy2 = vmlaq_f32(gy2, m_gy, m_gy);</div><div class="line"><a name="l00094"></a><span class="lineno"> 94</span>  gy2 = vmlaq_f32(gy2, r_gy, r_gy);</div><div class="line"><a name="l00095"></a><span class="lineno"> 95</span> </div><div class="line"><a name="l00096"></a><span class="lineno"> 96</span>  <span class="comment">// Gx*Gy</span></div><div class="line"><a name="l00097"></a><span class="lineno"> 97</span>  gxgy = vmlaq_f32(gxgy, l_gx, l_gy);</div><div class="line"><a name="l00098"></a><span class="lineno"> 98</span>  gxgy = vmlaq_f32(gxgy, m_gx, m_gy);</div><div class="line"><a name="l00099"></a><span class="lineno"> 99</span>  gxgy = vmlaq_f32(gxgy, r_gx, r_gy);</div><div class="line"><a name="l00100"></a><span class="lineno"> 100</span> }</div><div class="line"><a name="l00101"></a><span class="lineno"> 101</span> </div><div class="line"><a name="l00102"></a><span class="lineno"> 102</span> <span class="keyword">inline</span> <span class="keywordtype">void</span> harris_score1x5_FLOAT_FLOAT_FLOAT(float32x4_t low_gx, float32x4_t low_gy, float32x4_t high_gx, float32x4_t high_gy, float32x4_t &gx2, float32x4_t &gy2, float32x4_t &gxgy,</div><div class="line"><a name="l00103"></a><span class="lineno"> 103</span>  float32x4_t norm_factor)</div><div class="line"><a name="l00104"></a><span class="lineno"> 104</span> {</div><div class="line"><a name="l00105"></a><span class="lineno"> 105</span>  <span class="comment">// Normalize</span></div><div class="line"><a name="l00106"></a><span class="lineno"> 106</span>  low_gx = vmulq_f32(low_gx, norm_factor);</div><div class="line"><a name="l00107"></a><span class="lineno"> 107</span>  low_gy = vmulq_f32(low_gy, norm_factor);</div><div class="line"><a name="l00108"></a><span class="lineno"> 108</span>  high_gx = vmulq_f32(high_gx, norm_factor);</div><div class="line"><a name="l00109"></a><span class="lineno"> 109</span>  high_gy = vmulq_f32(high_gy, norm_factor);</div><div class="line"><a name="l00110"></a><span class="lineno"> 110</span> </div><div class="line"><a name="l00111"></a><span class="lineno"> 111</span>  <span class="comment">// L2 values</span></div><div class="line"><a name="l00112"></a><span class="lineno"> 112</span>  float32x4_t gx = low_gx;</div><div class="line"><a name="l00113"></a><span class="lineno"> 113</span>  float32x4_t gy = low_gy;</div><div class="line"><a name="l00114"></a><span class="lineno"> 114</span> </div><div class="line"><a name="l00115"></a><span class="lineno"> 115</span>  <span class="comment">// Accumulate</span></div><div class="line"><a name="l00116"></a><span class="lineno"> 116</span>  gx2 = vmlaq_f32(gx2, gx, gx);</div><div class="line"><a name="l00117"></a><span class="lineno"> 117</span>  gy2 = vmlaq_f32(gy2, gy, gy);</div><div class="line"><a name="l00118"></a><span class="lineno"> 118</span>  gxgy = vmlaq_f32(gxgy, gx, gy);</div><div class="line"><a name="l00119"></a><span class="lineno"> 119</span> </div><div class="line"><a name="l00120"></a><span class="lineno"> 120</span>  <span class="comment">// L1 values</span></div><div class="line"><a name="l00121"></a><span class="lineno"> 121</span>  gx = vextq_f32(low_gx, high_gx, 1);</div><div class="line"><a name="l00122"></a><span class="lineno"> 122</span>  gy = vextq_f32(low_gy, high_gy, 1);</div><div class="line"><a name="l00123"></a><span class="lineno"> 123</span> </div><div class="line"><a name="l00124"></a><span class="lineno"> 124</span>  <span class="comment">// Accumulate</span></div><div class="line"><a name="l00125"></a><span class="lineno"> 125</span>  gx2 = vmlaq_f32(gx2, gx, gx);</div><div class="line"><a name="l00126"></a><span class="lineno"> 126</span>  gy2 = vmlaq_f32(gy2, gy, gy);</div><div class="line"><a name="l00127"></a><span class="lineno"> 127</span>  gxgy = vmlaq_f32(gxgy, gx, gy);</div><div class="line"><a name="l00128"></a><span class="lineno"> 128</span> </div><div class="line"><a name="l00129"></a><span class="lineno"> 129</span>  <span class="comment">// M values</span></div><div class="line"><a name="l00130"></a><span class="lineno"> 130</span>  gx = vextq_f32(low_gx, high_gx, 2);</div><div class="line"><a name="l00131"></a><span class="lineno"> 131</span>  gy = vextq_f32(low_gy, high_gy, 2);</div><div class="line"><a name="l00132"></a><span class="lineno"> 132</span> </div><div class="line"><a name="l00133"></a><span class="lineno"> 133</span>  <span class="comment">// Accumulate</span></div><div class="line"><a name="l00134"></a><span class="lineno"> 134</span>  gx2 = vmlaq_f32(gx2, gx, gx);</div><div class="line"><a name="l00135"></a><span class="lineno"> 135</span>  gy2 = vmlaq_f32(gy2, gy, gy);</div><div class="line"><a name="l00136"></a><span class="lineno"> 136</span>  gxgy = vmlaq_f32(gxgy, gx, gy);</div><div class="line"><a name="l00137"></a><span class="lineno"> 137</span> </div><div class="line"><a name="l00138"></a><span class="lineno"> 138</span>  <span class="comment">// R1 values</span></div><div class="line"><a name="l00139"></a><span class="lineno"> 139</span>  gx = vextq_f32(low_gx, high_gx, 3);</div><div class="line"><a name="l00140"></a><span class="lineno"> 140</span>  gy = vextq_f32(low_gy, high_gy, 3);</div><div class="line"><a name="l00141"></a><span class="lineno"> 141</span> </div><div class="line"><a name="l00142"></a><span class="lineno"> 142</span>  <span class="comment">// Accumulate</span></div><div class="line"><a name="l00143"></a><span class="lineno"> 143</span>  gx2 = vmlaq_f32(gx2, gx, gx);</div><div class="line"><a name="l00144"></a><span class="lineno"> 144</span>  gy2 = vmlaq_f32(gy2, gy, gy);</div><div class="line"><a name="l00145"></a><span class="lineno"> 145</span>  gxgy = vmlaq_f32(gxgy, gx, gy);</div><div class="line"><a name="l00146"></a><span class="lineno"> 146</span> </div><div class="line"><a name="l00147"></a><span class="lineno"> 147</span>  <span class="comment">// R2 values</span></div><div class="line"><a name="l00148"></a><span class="lineno"> 148</span>  gx = high_gx;</div><div class="line"><a name="l00149"></a><span class="lineno"> 149</span>  gy = high_gy;</div><div class="line"><a name="l00150"></a><span class="lineno"> 150</span> </div><div class="line"><a name="l00151"></a><span class="lineno"> 151</span>  <span class="comment">// Accumulate</span></div><div class="line"><a name="l00152"></a><span class="lineno"> 152</span>  gx2 = vmlaq_f32(gx2, gx, gx);</div><div class="line"><a name="l00153"></a><span class="lineno"> 153</span>  gy2 = vmlaq_f32(gy2, gy, gy);</div><div class="line"><a name="l00154"></a><span class="lineno"> 154</span>  gxgy = vmlaq_f32(gxgy, gx, gy);</div><div class="line"><a name="l00155"></a><span class="lineno"> 155</span> }</div><div class="line"><a name="l00156"></a><span class="lineno"> 156</span> </div><div class="line"><a name="l00157"></a><span class="lineno"> 157</span> <span class="keyword">inline</span> <span class="keywordtype">void</span> harris_score1x7_FLOAT_FLOAT_FLOAT(float32x4_t low_gx, float32x4_t low_gy, float32x4_t high_gx, float32x4_t high_gy, float32x4_t high_gx1, float32x4_t high_gy1, float32x4_t &gx2,</div><div class="line"><a name="l00158"></a><span class="lineno"> 158</span>  float32x4_t &gy2, float32x4_t &gxgy, float32x4_t norm_factor)</div><div class="line"><a name="l00159"></a><span class="lineno"> 159</span> {</div><div class="line"><a name="l00160"></a><span class="lineno"> 160</span>  <span class="comment">// Normalize</span></div><div class="line"><a name="l00161"></a><span class="lineno"> 161</span>  low_gx = vmulq_f32(low_gx, norm_factor);</div><div class="line"><a name="l00162"></a><span class="lineno"> 162</span>  low_gy = vmulq_f32(low_gy, norm_factor);</div><div class="line"><a name="l00163"></a><span class="lineno"> 163</span>  high_gx = vmulq_f32(high_gx, norm_factor);</div><div class="line"><a name="l00164"></a><span class="lineno"> 164</span>  high_gy = vmulq_f32(high_gy, norm_factor);</div><div class="line"><a name="l00165"></a><span class="lineno"> 165</span> </div><div class="line"><a name="l00166"></a><span class="lineno"> 166</span>  <span class="comment">// L3 values</span></div><div class="line"><a name="l00167"></a><span class="lineno"> 167</span>  float32x4_t gx = low_gx;</div><div class="line"><a name="l00168"></a><span class="lineno"> 168</span>  float32x4_t gy = low_gy;</div><div class="line"><a name="l00169"></a><span class="lineno"> 169</span> </div><div class="line"><a name="l00170"></a><span class="lineno"> 170</span>  <span class="comment">// Accumulate</span></div><div class="line"><a name="l00171"></a><span class="lineno"> 171</span>  gx2 = vmlaq_f32(gx2, gx, gx);</div><div class="line"><a name="l00172"></a><span class="lineno"> 172</span>  gy2 = vmlaq_f32(gy2, gy, gy);</div><div class="line"><a name="l00173"></a><span class="lineno"> 173</span>  gxgy = vmlaq_f32(gxgy, gx, gy);</div><div class="line"><a name="l00174"></a><span class="lineno"> 174</span> </div><div class="line"><a name="l00175"></a><span class="lineno"> 175</span>  <span class="comment">// L2 values</span></div><div class="line"><a name="l00176"></a><span class="lineno"> 176</span>  gx = vextq_f32(low_gx, high_gx, 1);</div><div class="line"><a name="l00177"></a><span class="lineno"> 177</span>  gy = vextq_f32(low_gy, high_gy, 1);</div><div class="line"><a name="l00178"></a><span class="lineno"> 178</span> </div><div class="line"><a name="l00179"></a><span class="lineno"> 179</span>  <span class="comment">// Accumulate</span></div><div class="line"><a name="l00180"></a><span class="lineno"> 180</span>  gx2 = vmlaq_f32(gx2, gx, gx);</div><div class="line"><a name="l00181"></a><span class="lineno"> 181</span>  gy2 = vmlaq_f32(gy2, gy, gy);</div><div class="line"><a name="l00182"></a><span class="lineno"> 182</span>  gxgy = vmlaq_f32(gxgy, gx, gy);</div><div class="line"><a name="l00183"></a><span class="lineno"> 183</span> </div><div class="line"><a name="l00184"></a><span class="lineno"> 184</span>  <span class="comment">// L1 values</span></div><div class="line"><a name="l00185"></a><span class="lineno"> 185</span>  gx = vextq_f32(low_gx, high_gx, 2);</div><div class="line"><a name="l00186"></a><span class="lineno"> 186</span>  gy = vextq_f32(low_gy, high_gy, 2);</div><div class="line"><a name="l00187"></a><span class="lineno"> 187</span> </div><div class="line"><a name="l00188"></a><span class="lineno"> 188</span>  <span class="comment">// Accumulate</span></div><div class="line"><a name="l00189"></a><span class="lineno"> 189</span>  gx2 = vmlaq_f32(gx2, gx, gx);</div><div class="line"><a name="l00190"></a><span class="lineno"> 190</span>  gy2 = vmlaq_f32(gy2, gy, gy);</div><div class="line"><a name="l00191"></a><span class="lineno"> 191</span>  gxgy = vmlaq_f32(gxgy, gx, gy);</div><div class="line"><a name="l00192"></a><span class="lineno"> 192</span> </div><div class="line"><a name="l00193"></a><span class="lineno"> 193</span>  <span class="comment">// M values</span></div><div class="line"><a name="l00194"></a><span class="lineno"> 194</span>  gx = vextq_f32(low_gx, high_gx, 3);</div><div class="line"><a name="l00195"></a><span class="lineno"> 195</span>  gy = vextq_f32(low_gy, high_gy, 3);</div><div class="line"><a name="l00196"></a><span class="lineno"> 196</span> </div><div class="line"><a name="l00197"></a><span class="lineno"> 197</span>  <span class="comment">// Accumulate</span></div><div class="line"><a name="l00198"></a><span class="lineno"> 198</span>  gx2 = vmlaq_f32(gx2, gx, gx);</div><div class="line"><a name="l00199"></a><span class="lineno"> 199</span>  gy2 = vmlaq_f32(gy2, gy, gy);</div><div class="line"><a name="l00200"></a><span class="lineno"> 200</span>  gxgy = vmlaq_f32(gxgy, gx, gy);</div><div class="line"><a name="l00201"></a><span class="lineno"> 201</span> </div><div class="line"><a name="l00202"></a><span class="lineno"> 202</span>  <span class="comment">// R1 values</span></div><div class="line"><a name="l00203"></a><span class="lineno"> 203</span>  gx = high_gx;</div><div class="line"><a name="l00204"></a><span class="lineno"> 204</span>  gy = high_gy;</div><div class="line"><a name="l00205"></a><span class="lineno"> 205</span> </div><div class="line"><a name="l00206"></a><span class="lineno"> 206</span>  <span class="comment">// Accumulate</span></div><div class="line"><a name="l00207"></a><span class="lineno"> 207</span>  gx2 = vmlaq_f32(gx2, gx, gx);</div><div class="line"><a name="l00208"></a><span class="lineno"> 208</span>  gy2 = vmlaq_f32(gy2, gy, gy);</div><div class="line"><a name="l00209"></a><span class="lineno"> 209</span>  gxgy = vmlaq_f32(gxgy, gx, gy);</div><div class="line"><a name="l00210"></a><span class="lineno"> 210</span> </div><div class="line"><a name="l00211"></a><span class="lineno"> 211</span>  <span class="comment">// Change tmp_low and tmp_high for calculating R2 and R3 values</span></div><div class="line"><a name="l00212"></a><span class="lineno"> 212</span>  low_gx = high_gx;</div><div class="line"><a name="l00213"></a><span class="lineno"> 213</span>  low_gy = high_gy;</div><div class="line"><a name="l00214"></a><span class="lineno"> 214</span>  high_gx = high_gx1;</div><div class="line"><a name="l00215"></a><span class="lineno"> 215</span>  high_gy = high_gy1;</div><div class="line"><a name="l00216"></a><span class="lineno"> 216</span> </div><div class="line"><a name="l00217"></a><span class="lineno"> 217</span>  <span class="comment">// Normalize</span></div><div class="line"><a name="l00218"></a><span class="lineno"> 218</span>  high_gx = vmulq_f32(high_gx, norm_factor);</div><div class="line"><a name="l00219"></a><span class="lineno"> 219</span>  high_gy = vmulq_f32(high_gy, norm_factor);</div><div class="line"><a name="l00220"></a><span class="lineno"> 220</span> </div><div class="line"><a name="l00221"></a><span class="lineno"> 221</span>  <span class="comment">// R2 values</span></div><div class="line"><a name="l00222"></a><span class="lineno"> 222</span>  gx = vextq_f32(low_gx, high_gx, 1);</div><div class="line"><a name="l00223"></a><span class="lineno"> 223</span>  gy = vextq_f32(low_gy, high_gy, 1);</div><div class="line"><a name="l00224"></a><span class="lineno"> 224</span> </div><div class="line"><a name="l00225"></a><span class="lineno"> 225</span>  <span class="comment">// Accumulate</span></div><div class="line"><a name="l00226"></a><span class="lineno"> 226</span>  gx2 = vmlaq_f32(gx2, gx, gx);</div><div class="line"><a name="l00227"></a><span class="lineno"> 227</span>  gy2 = vmlaq_f32(gy2, gy, gy);</div><div class="line"><a name="l00228"></a><span class="lineno"> 228</span>  gxgy = vmlaq_f32(gxgy, gx, gy);</div><div class="line"><a name="l00229"></a><span class="lineno"> 229</span> </div><div class="line"><a name="l00230"></a><span class="lineno"> 230</span>  <span class="comment">// R3 values</span></div><div class="line"><a name="l00231"></a><span class="lineno"> 231</span>  gx = vextq_f32(low_gx, high_gx, 2);</div><div class="line"><a name="l00232"></a><span class="lineno"> 232</span>  gy = vextq_f32(low_gy, high_gy, 2);</div><div class="line"><a name="l00233"></a><span class="lineno"> 233</span> </div><div class="line"><a name="l00234"></a><span class="lineno"> 234</span>  <span class="comment">// Accumulate</span></div><div class="line"><a name="l00235"></a><span class="lineno"> 235</span>  gx2 = vmlaq_f32(gx2, gx, gx);</div><div class="line"><a name="l00236"></a><span class="lineno"> 236</span>  gy2 = vmlaq_f32(gy2, gy, gy);</div><div class="line"><a name="l00237"></a><span class="lineno"> 237</span>  gxgy = vmlaq_f32(gxgy, gx, gy);</div><div class="line"><a name="l00238"></a><span class="lineno"> 238</span> }</div><div class="line"><a name="l00239"></a><span class="lineno"> 239</span> </div><div class="line"><a name="l00240"></a><span class="lineno"> 240</span> <span class="keyword">inline</span> <span class="keywordtype">void</span> harris_score3x3_S16_S16_FLOAT(<span class="keyword">const</span> <span class="keywordtype">void</span> *__restrict input1_ptr, <span class="keyword">const</span> <span class="keywordtype">void</span> *__restrict input2_ptr, <span class="keywordtype">void</span> *__restrict output_ptr, int32_t input_stride,</div><div class="line"><a name="l00241"></a><span class="lineno"> 241</span>  <span class="keywordtype">float</span> in_norm_factor, <span class="keywordtype">float</span> in_sensitivity, <span class="keywordtype">float</span> in_strength_thresh)</div><div class="line"><a name="l00242"></a><span class="lineno"> 242</span> </div><div class="line"><a name="l00243"></a><span class="lineno"> 243</span> {</div><div class="line"><a name="l00244"></a><span class="lineno"> 244</span>  <span class="keyword">const</span> <span class="keyword">auto</span> gx_ptr_0 = static_cast<const int16_t *__restrict>(input1_ptr) - 1;</div><div class="line"><a name="l00245"></a><span class="lineno"> 245</span>  <span class="keyword">const</span> <span class="keyword">auto</span> gy_ptr_0 = static_cast<const int16_t *__restrict>(input2_ptr) - 1;</div><div class="line"><a name="l00246"></a><span class="lineno"> 246</span>  <span class="keyword">const</span> int16_t *gx_ptr_1 = gx_ptr_0 + 4;</div><div class="line"><a name="l00247"></a><span class="lineno"> 247</span>  <span class="keyword">const</span> int16_t *gy_ptr_1 = gy_ptr_0 + 4;</div><div class="line"><a name="l00248"></a><span class="lineno"> 248</span>  <span class="keyword">const</span> <span class="keyword">auto</span> output = static_cast<float *__restrict>(output_ptr);</div><div class="line"><a name="l00249"></a><span class="lineno"> 249</span> </div><div class="line"><a name="l00250"></a><span class="lineno"> 250</span>  <span class="comment">// Gx^2, Gy^2 and Gx*Gy</span></div><div class="line"><a name="l00251"></a><span class="lineno"> 251</span>  float32x4x2_t gx2 =</div><div class="line"><a name="l00252"></a><span class="lineno"> 252</span>  {</div><div class="line"><a name="l00253"></a><span class="lineno"> 253</span>  {</div><div class="line"><a name="l00254"></a><span class="lineno"> 254</span>  vdupq_n_f32(0.0f),</div><div class="line"><a name="l00255"></a><span class="lineno"> 255</span>  vdupq_n_f32(0.0f)</div><div class="line"><a name="l00256"></a><span class="lineno"> 256</span>  }</div><div class="line"><a name="l00257"></a><span class="lineno"> 257</span>  };</div><div class="line"><a name="l00258"></a><span class="lineno"> 258</span>  float32x4x2_t gy2 =</div><div class="line"><a name="l00259"></a><span class="lineno"> 259</span>  {</div><div class="line"><a name="l00260"></a><span class="lineno"> 260</span>  {</div><div class="line"><a name="l00261"></a><span class="lineno"> 261</span>  vdupq_n_f32(0.0f),</div><div class="line"><a name="l00262"></a><span class="lineno"> 262</span>  vdupq_n_f32(0.0f)</div><div class="line"><a name="l00263"></a><span class="lineno"> 263</span>  }</div><div class="line"><a name="l00264"></a><span class="lineno"> 264</span>  };</div><div class="line"><a name="l00265"></a><span class="lineno"> 265</span>  float32x4x2_t gxgy =</div><div class="line"><a name="l00266"></a><span class="lineno"> 266</span>  {</div><div class="line"><a name="l00267"></a><span class="lineno"> 267</span>  {</div><div class="line"><a name="l00268"></a><span class="lineno"> 268</span>  vdupq_n_f32(0.0f),</div><div class="line"><a name="l00269"></a><span class="lineno"> 269</span>  vdupq_n_f32(0.0f)</div><div class="line"><a name="l00270"></a><span class="lineno"> 270</span>  }</div><div class="line"><a name="l00271"></a><span class="lineno"> 271</span>  };</div><div class="line"><a name="l00272"></a><span class="lineno"> 272</span> </div><div class="line"><a name="l00273"></a><span class="lineno"> 273</span>  <span class="comment">// Row0</span></div><div class="line"><a name="l00274"></a><span class="lineno"> 274</span>  int16x8x2_t tmp_gx =</div><div class="line"><a name="l00275"></a><span class="lineno"> 275</span>  {</div><div class="line"><a name="l00276"></a><span class="lineno"> 276</span>  {</div><div class="line"><a name="l00277"></a><span class="lineno"> 277</span>  vld1q_s16(gx_ptr_0 - input_stride),</div><div class="line"><a name="l00278"></a><span class="lineno"> 278</span>  vld1q_s16(gx_ptr_1 - input_stride)</div><div class="line"><a name="l00279"></a><span class="lineno"> 279</span>  }</div><div class="line"><a name="l00280"></a><span class="lineno"> 280</span>  };</div><div class="line"><a name="l00281"></a><span class="lineno"> 281</span>  int16x8x2_t tmp_gy =</div><div class="line"><a name="l00282"></a><span class="lineno"> 282</span>  {</div><div class="line"><a name="l00283"></a><span class="lineno"> 283</span>  {</div><div class="line"><a name="l00284"></a><span class="lineno"> 284</span>  vld1q_s16(gy_ptr_0 - input_stride),</div><div class="line"><a name="l00285"></a><span class="lineno"> 285</span>  vld1q_s16(gy_ptr_1 - input_stride)</div><div class="line"><a name="l00286"></a><span class="lineno"> 286</span>  }</div><div class="line"><a name="l00287"></a><span class="lineno"> 287</span>  };</div><div class="line"><a name="l00288"></a><span class="lineno"> 288</span>  float32x4_t sensitivity = vdupq_n_f32(in_sensitivity);</div><div class="line"><a name="l00289"></a><span class="lineno"> 289</span>  float32x4_t norm_factor = vdupq_n_f32(in_norm_factor);</div><div class="line"><a name="l00290"></a><span class="lineno"> 290</span>  float32x4_t strength_thresh = vdupq_n_f32(in_strength_thresh);</div><div class="line"><a name="l00291"></a><span class="lineno"> 291</span> </div><div class="line"><a name="l00292"></a><span class="lineno"> 292</span>  float32x4_t low_gx = vcvtq_f32_s32(vmovl_s16(vget_low_s16(tmp_gx.val[0])));</div><div class="line"><a name="l00293"></a><span class="lineno"> 293</span>  float32x4_t low_gy = vcvtq_f32_s32(vmovl_s16(vget_low_s16(tmp_gy.val[0])));</div><div class="line"><a name="l00294"></a><span class="lineno"> 294</span>  float32x4_t high_gx = vcvtq_f32_s32(vmovl_s16(vget_high_s16(tmp_gx.val[0])));</div><div class="line"><a name="l00295"></a><span class="lineno"> 295</span>  float32x4_t high_gy = vcvtq_f32_s32(vmovl_s16(vget_high_s16(tmp_gy.val[0])));</div><div class="line"><a name="l00296"></a><span class="lineno"> 296</span>  harris_score1x3_FLOAT_FLOAT_FLOAT(low_gx, low_gy, high_gx, high_gy, gx2.val[0], gy2.val[0], gxgy.val[0], norm_factor);</div><div class="line"><a name="l00297"></a><span class="lineno"> 297</span> </div><div class="line"><a name="l00298"></a><span class="lineno"> 298</span>  low_gx = vcvtq_f32_s32(vmovl_s16(vget_low_s16(tmp_gx.val[1])));</div><div class="line"><a name="l00299"></a><span class="lineno"> 299</span>  low_gy = vcvtq_f32_s32(vmovl_s16(vget_low_s16(tmp_gy.val[1])));</div><div class="line"><a name="l00300"></a><span class="lineno"> 300</span>  high_gx = vcvtq_f32_s32(vmovl_s16(vget_high_s16(tmp_gx.val[1])));</div><div class="line"><a name="l00301"></a><span class="lineno"> 301</span>  high_gy = vcvtq_f32_s32(vmovl_s16(vget_high_s16(tmp_gy.val[1])));</div><div class="line"><a name="l00302"></a><span class="lineno"> 302</span>  harris_score1x3_FLOAT_FLOAT_FLOAT(low_gx, low_gy, high_gx, high_gy, gx2.val[1], gy2.val[1], gxgy.val[1], norm_factor);</div><div class="line"><a name="l00303"></a><span class="lineno"> 303</span> </div><div class="line"><a name="l00304"></a><span class="lineno"> 304</span>  <span class="comment">// Row1</span></div><div class="line"><a name="l00305"></a><span class="lineno"> 305</span>  tmp_gx.val[0] = vld1q_s16(gx_ptr_0);</div><div class="line"><a name="l00306"></a><span class="lineno"> 306</span>  tmp_gy.val[0] = vld1q_s16(gy_ptr_0);</div><div class="line"><a name="l00307"></a><span class="lineno"> 307</span>  tmp_gx.val[1] = vld1q_s16(gx_ptr_1);</div><div class="line"><a name="l00308"></a><span class="lineno"> 308</span>  tmp_gy.val[1] = vld1q_s16(gy_ptr_1);</div><div class="line"><a name="l00309"></a><span class="lineno"> 309</span> </div><div class="line"><a name="l00310"></a><span class="lineno"> 310</span>  low_gx = vcvtq_f32_s32(vmovl_s16(vget_low_s16(tmp_gx.val[0])));</div><div class="line"><a name="l00311"></a><span class="lineno"> 311</span>  low_gy = vcvtq_f32_s32(vmovl_s16(vget_low_s16(tmp_gy.val[0])));</div><div class="line"><a name="l00312"></a><span class="lineno"> 312</span>  high_gx = vcvtq_f32_s32(vmovl_s16(vget_high_s16(tmp_gx.val[0])));</div><div class="line"><a name="l00313"></a><span class="lineno"> 313</span>  high_gy = vcvtq_f32_s32(vmovl_s16(vget_high_s16(tmp_gy.val[0])));</div><div class="line"><a name="l00314"></a><span class="lineno"> 314</span>  harris_score1x3_FLOAT_FLOAT_FLOAT(low_gx, low_gy, high_gx, high_gy, gx2.val[0], gy2.val[0], gxgy.val[0], norm_factor);</div><div class="line"><a name="l00315"></a><span class="lineno"> 315</span> </div><div class="line"><a name="l00316"></a><span class="lineno"> 316</span>  low_gx = vcvtq_f32_s32(vmovl_s16(vget_low_s16(tmp_gx.val[1])));</div><div class="line"><a name="l00317"></a><span class="lineno"> 317</span>  low_gy = vcvtq_f32_s32(vmovl_s16(vget_low_s16(tmp_gy.val[1])));</div><div class="line"><a name="l00318"></a><span class="lineno"> 318</span>  high_gx = vcvtq_f32_s32(vmovl_s16(vget_high_s16(tmp_gx.val[1])));</div><div class="line"><a name="l00319"></a><span class="lineno"> 319</span>  high_gy = vcvtq_f32_s32(vmovl_s16(vget_high_s16(tmp_gy.val[1])));</div><div class="line"><a name="l00320"></a><span class="lineno"> 320</span>  harris_score1x3_FLOAT_FLOAT_FLOAT(low_gx, low_gy, high_gx, high_gy, gx2.val[1], gy2.val[1], gxgy.val[1], norm_factor);</div><div class="line"><a name="l00321"></a><span class="lineno"> 321</span> </div><div class="line"><a name="l00322"></a><span class="lineno"> 322</span>  <span class="comment">// Row2</span></div><div class="line"><a name="l00323"></a><span class="lineno"> 323</span>  tmp_gx.val[0] = vld1q_s16(gx_ptr_0 + input_stride);</div><div class="line"><a name="l00324"></a><span class="lineno"> 324</span>  tmp_gy.val[0] = vld1q_s16(gy_ptr_0 + input_stride);</div><div class="line"><a name="l00325"></a><span class="lineno"> 325</span>  tmp_gx.val[1] = vld1q_s16(gx_ptr_1 + input_stride);</div><div class="line"><a name="l00326"></a><span class="lineno"> 326</span>  tmp_gy.val[1] = vld1q_s16(gy_ptr_1 + input_stride);</div><div class="line"><a name="l00327"></a><span class="lineno"> 327</span> </div><div class="line"><a name="l00328"></a><span class="lineno"> 328</span>  low_gx = vcvtq_f32_s32(vmovl_s16(vget_low_s16(tmp_gx.val[0])));</div><div class="line"><a name="l00329"></a><span class="lineno"> 329</span>  low_gy = vcvtq_f32_s32(vmovl_s16(vget_low_s16(tmp_gy.val[0])));</div><div class="line"><a name="l00330"></a><span class="lineno"> 330</span>  high_gx = vcvtq_f32_s32(vmovl_s16(vget_high_s16(tmp_gx.val[0])));</div><div class="line"><a name="l00331"></a><span class="lineno"> 331</span>  high_gy = vcvtq_f32_s32(vmovl_s16(vget_high_s16(tmp_gy.val[0])));</div><div class="line"><a name="l00332"></a><span class="lineno"> 332</span>  harris_score1x3_FLOAT_FLOAT_FLOAT(low_gx, low_gy, high_gx, high_gy, gx2.val[0], gy2.val[0], gxgy.val[0], norm_factor);</div><div class="line"><a name="l00333"></a><span class="lineno"> 333</span> </div><div class="line"><a name="l00334"></a><span class="lineno"> 334</span>  low_gx = vcvtq_f32_s32(vmovl_s16(vget_low_s16(tmp_gx.val[1])));</div><div class="line"><a name="l00335"></a><span class="lineno"> 335</span>  low_gy = vcvtq_f32_s32(vmovl_s16(vget_low_s16(tmp_gy.val[1])));</div><div class="line"><a name="l00336"></a><span class="lineno"> 336</span>  high_gx = vcvtq_f32_s32(vmovl_s16(vget_high_s16(tmp_gx.val[1])));</div><div class="line"><a name="l00337"></a><span class="lineno"> 337</span>  high_gy = vcvtq_f32_s32(vmovl_s16(vget_high_s16(tmp_gy.val[1])));</div><div class="line"><a name="l00338"></a><span class="lineno"> 338</span>  harris_score1x3_FLOAT_FLOAT_FLOAT(low_gx, low_gy, high_gx, high_gy, gx2.val[1], gy2.val[1], gxgy.val[1], norm_factor);</div><div class="line"><a name="l00339"></a><span class="lineno"> 339</span> </div><div class="line"><a name="l00340"></a><span class="lineno"> 340</span>  <span class="comment">// Calculate harris score</span></div><div class="line"><a name="l00341"></a><span class="lineno"> 341</span>  <span class="keyword">const</span> float32x4x2_t mc =</div><div class="line"><a name="l00342"></a><span class="lineno"> 342</span>  {</div><div class="line"><a name="l00343"></a><span class="lineno"> 343</span>  {</div><div class="line"><a name="l00344"></a><span class="lineno"> 344</span>  harris_score(gx2.val[0], gy2.val[0], gxgy.val[0], sensitivity, strength_thresh),</div><div class="line"><a name="l00345"></a><span class="lineno"> 345</span>  harris_score(gx2.val[1], gy2.val[1], gxgy.val[1], sensitivity, strength_thresh)</div><div class="line"><a name="l00346"></a><span class="lineno"> 346</span>  }</div><div class="line"><a name="l00347"></a><span class="lineno"> 347</span>  };</div><div class="line"><a name="l00348"></a><span class="lineno"> 348</span> </div><div class="line"><a name="l00349"></a><span class="lineno"> 349</span>  <span class="comment">// Store score</span></div><div class="line"><a name="l00350"></a><span class="lineno"> 350</span>  vst1q_f32(output + 0, mc.val[0]);</div><div class="line"><a name="l00351"></a><span class="lineno"> 351</span>  vst1q_f32(output + 4, mc.val[1]);</div><div class="line"><a name="l00352"></a><span class="lineno"> 352</span> }</div><div class="line"><a name="l00353"></a><span class="lineno"> 353</span> </div><div class="line"><a name="l00354"></a><span class="lineno"> 354</span> <span class="keyword">inline</span> <span class="keywordtype">void</span> harris_score3x3_S32_S32_FLOAT(<span class="keyword">const</span> <span class="keywordtype">void</span> *__restrict input1_ptr, <span class="keyword">const</span> <span class="keywordtype">void</span> *__restrict input2_ptr, <span class="keywordtype">void</span> *__restrict output_ptr, int32_t input_stride,</div><div class="line"><a name="l00355"></a><span class="lineno"> 355</span>  <span class="keywordtype">float</span> in_norm_factor, <span class="keywordtype">float</span> in_sensitivity, <span class="keywordtype">float</span> in_strength_thresh)</div><div class="line"><a name="l00356"></a><span class="lineno"> 356</span> {</div><div class="line"><a name="l00357"></a><span class="lineno"> 357</span>  <span class="keyword">auto</span> gx_ptr_0 = static_cast<const int32_t *__restrict>(input1_ptr) - 1;</div><div class="line"><a name="l00358"></a><span class="lineno"> 358</span>  <span class="keyword">auto</span> gy_ptr_0 = static_cast<const int32_t *__restrict>(input2_ptr) - 1;</div><div class="line"><a name="l00359"></a><span class="lineno"> 359</span>  <span class="keyword">const</span> int32_t *gx_ptr_1 = gx_ptr_0 + 4;</div><div class="line"><a name="l00360"></a><span class="lineno"> 360</span>  <span class="keyword">const</span> int32_t *gy_ptr_1 = gy_ptr_0 + 4;</div><div class="line"><a name="l00361"></a><span class="lineno"> 361</span>  <span class="keyword">const</span> int32_t *gx_ptr_2 = gx_ptr_0 + 8;</div><div class="line"><a name="l00362"></a><span class="lineno"> 362</span>  <span class="keyword">const</span> int32_t *gy_ptr_2 = gy_ptr_0 + 8;</div><div class="line"><a name="l00363"></a><span class="lineno"> 363</span>  <span class="keyword">const</span> <span class="keyword">auto</span> output = static_cast<float *__restrict>(output_ptr);</div><div class="line"><a name="l00364"></a><span class="lineno"> 364</span>  float32x4_t sensitivity = vdupq_n_f32(in_sensitivity);</div><div class="line"><a name="l00365"></a><span class="lineno"> 365</span>  float32x4_t norm_factor = vdupq_n_f32(in_norm_factor);</div><div class="line"><a name="l00366"></a><span class="lineno"> 366</span>  float32x4_t strength_thresh = vdupq_n_f32(in_strength_thresh);</div><div class="line"><a name="l00367"></a><span class="lineno"> 367</span> </div><div class="line"><a name="l00368"></a><span class="lineno"> 368</span>  <span class="comment">// Gx^2, Gy^2 and Gx*Gy</span></div><div class="line"><a name="l00369"></a><span class="lineno"> 369</span>  float32x4x2_t gx2 =</div><div class="line"><a name="l00370"></a><span class="lineno"> 370</span>  {</div><div class="line"><a name="l00371"></a><span class="lineno"> 371</span>  {</div><div class="line"><a name="l00372"></a><span class="lineno"> 372</span>  vdupq_n_f32(0.0f),</div><div class="line"><a name="l00373"></a><span class="lineno"> 373</span>  vdupq_n_f32(0.0f)</div><div class="line"><a name="l00374"></a><span class="lineno"> 374</span>  }</div><div class="line"><a name="l00375"></a><span class="lineno"> 375</span>  };</div><div class="line"><a name="l00376"></a><span class="lineno"> 376</span>  float32x4x2_t gy2 =</div><div class="line"><a name="l00377"></a><span class="lineno"> 377</span>  {</div><div class="line"><a name="l00378"></a><span class="lineno"> 378</span>  {</div><div class="line"><a name="l00379"></a><span class="lineno"> 379</span>  vdupq_n_f32(0.0f),</div><div class="line"><a name="l00380"></a><span class="lineno"> 380</span>  vdupq_n_f32(0.0f)</div><div class="line"><a name="l00381"></a><span class="lineno"> 381</span>  }</div><div class="line"><a name="l00382"></a><span class="lineno"> 382</span>  };</div><div class="line"><a name="l00383"></a><span class="lineno"> 383</span>  float32x4x2_t gxgy =</div><div class="line"><a name="l00384"></a><span class="lineno"> 384</span>  {</div><div class="line"><a name="l00385"></a><span class="lineno"> 385</span>  {</div><div class="line"><a name="l00386"></a><span class="lineno"> 386</span>  vdupq_n_f32(0.0f),</div><div class="line"><a name="l00387"></a><span class="lineno"> 387</span>  vdupq_n_f32(0.0f)</div><div class="line"><a name="l00388"></a><span class="lineno"> 388</span>  }</div><div class="line"><a name="l00389"></a><span class="lineno"> 389</span>  };</div><div class="line"><a name="l00390"></a><span class="lineno"> 390</span> </div><div class="line"><a name="l00391"></a><span class="lineno"> 391</span>  <span class="comment">// Row0</span></div><div class="line"><a name="l00392"></a><span class="lineno"> 392</span>  float32x4_t low_gx = vcvtq_f32_s32(vld1q_s32(gx_ptr_0 - input_stride));</div><div class="line"><a name="l00393"></a><span class="lineno"> 393</span>  float32x4_t low_gy = vcvtq_f32_s32(vld1q_s32(gy_ptr_0 - input_stride));</div><div class="line"><a name="l00394"></a><span class="lineno"> 394</span>  float32x4_t high_gx = vcvtq_f32_s32(vld1q_s32(gx_ptr_1 - input_stride));</div><div class="line"><a name="l00395"></a><span class="lineno"> 395</span>  float32x4_t high_gy = vcvtq_f32_s32(vld1q_s32(gy_ptr_1 - input_stride));</div><div class="line"><a name="l00396"></a><span class="lineno"> 396</span>  harris_score1x3_FLOAT_FLOAT_FLOAT(low_gx, low_gy, high_gx, high_gy, gx2.val[0], gy2.val[0], gxgy.val[0], norm_factor);</div><div class="line"><a name="l00397"></a><span class="lineno"> 397</span> </div><div class="line"><a name="l00398"></a><span class="lineno"> 398</span>  low_gx = vcvtq_f32_s32(vld1q_s32(gx_ptr_1 - input_stride));</div><div class="line"><a name="l00399"></a><span class="lineno"> 399</span>  low_gy = vcvtq_f32_s32(vld1q_s32(gy_ptr_1 - input_stride));</div><div class="line"><a name="l00400"></a><span class="lineno"> 400</span>  high_gx = vcvtq_f32_s32(vld1q_s32(gx_ptr_2 - input_stride));</div><div class="line"><a name="l00401"></a><span class="lineno"> 401</span>  high_gy = vcvtq_f32_s32(vld1q_s32(gy_ptr_2 - input_stride));</div><div class="line"><a name="l00402"></a><span class="lineno"> 402</span>  harris_score1x3_FLOAT_FLOAT_FLOAT(low_gx, low_gy, high_gx, high_gy, gx2.val[1], gy2.val[1], gxgy.val[1], norm_factor);</div><div class="line"><a name="l00403"></a><span class="lineno"> 403</span> </div><div class="line"><a name="l00404"></a><span class="lineno"> 404</span>  <span class="comment">// Row1</span></div><div class="line"><a name="l00405"></a><span class="lineno"> 405</span>  low_gx = vcvtq_f32_s32(vld1q_s32(gx_ptr_0));</div><div class="line"><a name="l00406"></a><span class="lineno"> 406</span>  low_gy = vcvtq_f32_s32(vld1q_s32(gy_ptr_0));</div><div class="line"><a name="l00407"></a><span class="lineno"> 407</span>  high_gx = vcvtq_f32_s32(vld1q_s32(gx_ptr_1));</div><div class="line"><a name="l00408"></a><span class="lineno"> 408</span>  high_gy = vcvtq_f32_s32(vld1q_s32(gy_ptr_1));</div><div class="line"><a name="l00409"></a><span class="lineno"> 409</span>  harris_score1x3_FLOAT_FLOAT_FLOAT(low_gx, low_gy, high_gx, high_gy, gx2.val[0], gy2.val[0], gxgy.val[0], norm_factor);</div><div class="line"><a name="l00410"></a><span class="lineno"> 410</span> </div><div class="line"><a name="l00411"></a><span class="lineno"> 411</span>  low_gx = vcvtq_f32_s32(vld1q_s32(gx_ptr_1));</div><div class="line"><a name="l00412"></a><span class="lineno"> 412</span>  low_gy = vcvtq_f32_s32(vld1q_s32(gy_ptr_1));</div><div class="line"><a name="l00413"></a><span class="lineno"> 413</span>  high_gx = vcvtq_f32_s32(vld1q_s32(gx_ptr_2));</div><div class="line"><a name="l00414"></a><span class="lineno"> 414</span>  high_gy = vcvtq_f32_s32(vld1q_s32(gy_ptr_2));</div><div class="line"><a name="l00415"></a><span class="lineno"> 415</span>  harris_score1x3_FLOAT_FLOAT_FLOAT(low_gx, low_gy, high_gx, high_gy, gx2.val[1], gy2.val[1], gxgy.val[1], norm_factor);</div><div class="line"><a name="l00416"></a><span class="lineno"> 416</span> </div><div class="line"><a name="l00417"></a><span class="lineno"> 417</span>  <span class="comment">// Row2</span></div><div class="line"><a name="l00418"></a><span class="lineno"> 418</span>  low_gx = vcvtq_f32_s32(vld1q_s32(gx_ptr_0 + input_stride));</div><div class="line"><a name="l00419"></a><span class="lineno"> 419</span>  low_gy = vcvtq_f32_s32(vld1q_s32(gy_ptr_0 + input_stride));</div><div class="line"><a name="l00420"></a><span class="lineno"> 420</span>  high_gx = vcvtq_f32_s32(vld1q_s32(gx_ptr_1 + input_stride));</div><div class="line"><a name="l00421"></a><span class="lineno"> 421</span>  high_gy = vcvtq_f32_s32(vld1q_s32(gy_ptr_1 + input_stride));</div><div class="line"><a name="l00422"></a><span class="lineno"> 422</span>  harris_score1x3_FLOAT_FLOAT_FLOAT(low_gx, low_gy, high_gx, high_gy, gx2.val[0], gy2.val[0], gxgy.val[0], norm_factor);</div><div class="line"><a name="l00423"></a><span class="lineno"> 423</span> </div><div class="line"><a name="l00424"></a><span class="lineno"> 424</span>  low_gx = vcvtq_f32_s32(vld1q_s32(gx_ptr_1 + input_stride));</div><div class="line"><a name="l00425"></a><span class="lineno"> 425</span>  low_gy = vcvtq_f32_s32(vld1q_s32(gy_ptr_1 + input_stride));</div><div class="line"><a name="l00426"></a><span class="lineno"> 426</span>  high_gx = vcvtq_f32_s32(vld1q_s32(gx_ptr_2 + input_stride));</div><div class="line"><a name="l00427"></a><span class="lineno"> 427</span>  high_gy = vcvtq_f32_s32(vld1q_s32(gy_ptr_2 + input_stride));</div><div class="line"><a name="l00428"></a><span class="lineno"> 428</span>  harris_score1x3_FLOAT_FLOAT_FLOAT(low_gx, low_gy, high_gx, high_gy, gx2.val[1], gy2.val[1], gxgy.val[1], norm_factor);</div><div class="line"><a name="l00429"></a><span class="lineno"> 429</span> </div><div class="line"><a name="l00430"></a><span class="lineno"> 430</span>  <span class="comment">// Calculate harris score</span></div><div class="line"><a name="l00431"></a><span class="lineno"> 431</span>  <span class="keyword">const</span> float32x4x2_t mc =</div><div class="line"><a name="l00432"></a><span class="lineno"> 432</span>  {</div><div class="line"><a name="l00433"></a><span class="lineno"> 433</span>  {</div><div class="line"><a name="l00434"></a><span class="lineno"> 434</span>  harris_score(gx2.val[0], gy2.val[0], gxgy.val[0], sensitivity, strength_thresh),</div><div class="line"><a name="l00435"></a><span class="lineno"> 435</span>  harris_score(gx2.val[1], gy2.val[1], gxgy.val[1], sensitivity, strength_thresh)</div><div class="line"><a name="l00436"></a><span class="lineno"> 436</span>  }</div><div class="line"><a name="l00437"></a><span class="lineno"> 437</span>  };</div><div class="line"><a name="l00438"></a><span class="lineno"> 438</span> </div><div class="line"><a name="l00439"></a><span class="lineno"> 439</span>  <span class="comment">// Store score</span></div><div class="line"><a name="l00440"></a><span class="lineno"> 440</span>  vst1q_f32(output + 0, mc.val[0]);</div><div class="line"><a name="l00441"></a><span class="lineno"> 441</span>  vst1q_f32(output + 4, mc.val[1]);</div><div class="line"><a name="l00442"></a><span class="lineno"> 442</span> }</div><div class="line"><a name="l00443"></a><span class="lineno"> 443</span> </div><div class="line"><a name="l00444"></a><span class="lineno"> 444</span> <span class="keyword">inline</span> <span class="keywordtype">void</span> harris_score5x5_S16_S16_FLOAT(<span class="keyword">const</span> <span class="keywordtype">void</span> *__restrict input1_ptr, <span class="keyword">const</span> <span class="keywordtype">void</span> *__restrict input2_ptr, <span class="keywordtype">void</span> *__restrict output_ptr, int32_t input_stride,</div><div class="line"><a name="l00445"></a><span class="lineno"> 445</span>  <span class="keywordtype">float</span> in_norm_factor, <span class="keywordtype">float</span> in_sensitivity, <span class="keywordtype">float</span> in_strength_thresh)</div><div class="line"><a name="l00446"></a><span class="lineno"> 446</span> {</div><div class="line"><a name="l00447"></a><span class="lineno"> 447</span>  <span class="keyword">auto</span> gx_ptr_0 = static_cast<const int16_t *__restrict>(input1_ptr) - 2 - 2 * input_stride;</div><div class="line"><a name="l00448"></a><span class="lineno"> 448</span>  <span class="keyword">auto</span> gy_ptr_0 = static_cast<const int16_t *__restrict>(input2_ptr) - 2 - 2 * input_stride;</div><div class="line"><a name="l00449"></a><span class="lineno"> 449</span>  <span class="keyword">const</span> int16_t *gx_ptr_1 = gx_ptr_0 + 4;</div><div class="line"><a name="l00450"></a><span class="lineno"> 450</span>  <span class="keyword">const</span> int16_t *gy_ptr_1 = gy_ptr_0 + 4;</div><div class="line"><a name="l00451"></a><span class="lineno"> 451</span>  <span class="keyword">const</span> <span class="keyword">auto</span> output = static_cast<float *__restrict>(output_ptr);</div><div class="line"><a name="l00452"></a><span class="lineno"> 452</span> </div><div class="line"><a name="l00453"></a><span class="lineno"> 453</span>  <span class="comment">// Gx^2, Gy^2 and Gx*Gy</span></div><div class="line"><a name="l00454"></a><span class="lineno"> 454</span>  float32x4x2_t gx2 =</div><div class="line"><a name="l00455"></a><span class="lineno"> 455</span>  {</div><div class="line"><a name="l00456"></a><span class="lineno"> 456</span>  {</div><div class="line"><a name="l00457"></a><span class="lineno"> 457</span>  vdupq_n_f32(0.0f),</div><div class="line"><a name="l00458"></a><span class="lineno"> 458</span>  vdupq_n_f32(0.0f)</div><div class="line"><a name="l00459"></a><span class="lineno"> 459</span>  }</div><div class="line"><a name="l00460"></a><span class="lineno"> 460</span>  };</div><div class="line"><a name="l00461"></a><span class="lineno"> 461</span>  float32x4x2_t gy2 =</div><div class="line"><a name="l00462"></a><span class="lineno"> 462</span>  {</div><div class="line"><a name="l00463"></a><span class="lineno"> 463</span>  {</div><div class="line"><a name="l00464"></a><span class="lineno"> 464</span>  vdupq_n_f32(0.0f),</div><div class="line"><a name="l00465"></a><span class="lineno"> 465</span>  vdupq_n_f32(0.0f)</div><div class="line"><a name="l00466"></a><span class="lineno"> 466</span>  }</div><div class="line"><a name="l00467"></a><span class="lineno"> 467</span>  };</div><div class="line"><a name="l00468"></a><span class="lineno"> 468</span>  float32x4x2_t gxgy =</div><div class="line"><a name="l00469"></a><span class="lineno"> 469</span>  {</div><div class="line"><a name="l00470"></a><span class="lineno"> 470</span>  {</div><div class="line"><a name="l00471"></a><span class="lineno"> 471</span>  vdupq_n_f32(0.0f),</div><div class="line"><a name="l00472"></a><span class="lineno"> 472</span>  vdupq_n_f32(0.0f)</div><div class="line"><a name="l00473"></a><span class="lineno"> 473</span>  }</div><div class="line"><a name="l00474"></a><span class="lineno"> 474</span>  };</div><div class="line"><a name="l00475"></a><span class="lineno"> 475</span>  float32x4_t sensitivity = vdupq_n_f32(in_sensitivity);</div><div class="line"><a name="l00476"></a><span class="lineno"> 476</span>  float32x4_t norm_factor = vdupq_n_f32(in_norm_factor);</div><div class="line"><a name="l00477"></a><span class="lineno"> 477</span>  float32x4_t strength_thresh = vdupq_n_f32(in_strength_thresh);</div><div class="line"><a name="l00478"></a><span class="lineno"> 478</span> </div><div class="line"><a name="l00479"></a><span class="lineno"> 479</span>  <span class="keywordflow">for</span>(<span class="keywordtype">int</span> i = 0; i < 5; ++i)</div><div class="line"><a name="l00480"></a><span class="lineno"> 480</span>  {</div><div class="line"><a name="l00481"></a><span class="lineno"> 481</span>  <span class="keyword">const</span> int16x8x2_t tmp_gx =</div><div class="line"><a name="l00482"></a><span class="lineno"> 482</span>  {</div><div class="line"><a name="l00483"></a><span class="lineno"> 483</span>  {</div><div class="line"><a name="l00484"></a><span class="lineno"> 484</span>  vld1q_s16(gx_ptr_0),</div><div class="line"><a name="l00485"></a><span class="lineno"> 485</span>  vld1q_s16(gx_ptr_1)</div><div class="line"><a name="l00486"></a><span class="lineno"> 486</span>  }</div><div class="line"><a name="l00487"></a><span class="lineno"> 487</span>  };</div><div class="line"><a name="l00488"></a><span class="lineno"> 488</span>  <span class="keyword">const</span> int16x8x2_t tmp_gy =</div><div class="line"><a name="l00489"></a><span class="lineno"> 489</span>  {</div><div class="line"><a name="l00490"></a><span class="lineno"> 490</span>  {</div><div class="line"><a name="l00491"></a><span class="lineno"> 491</span>  vld1q_s16(gy_ptr_0),</div><div class="line"><a name="l00492"></a><span class="lineno"> 492</span>  vld1q_s16(gy_ptr_1)</div><div class="line"><a name="l00493"></a><span class="lineno"> 493</span>  }</div><div class="line"><a name="l00494"></a><span class="lineno"> 494</span>  };</div><div class="line"><a name="l00495"></a><span class="lineno"> 495</span> </div><div class="line"><a name="l00496"></a><span class="lineno"> 496</span>  float32x4_t low_gx = vcvtq_f32_s32(vmovl_s16(vget_low_s16(tmp_gx.val[0])));</div><div class="line"><a name="l00497"></a><span class="lineno"> 497</span>  float32x4_t low_gy = vcvtq_f32_s32(vmovl_s16(vget_low_s16(tmp_gy.val[0])));</div><div class="line"><a name="l00498"></a><span class="lineno"> 498</span>  float32x4_t high_gx = vcvtq_f32_s32(vmovl_s16(vget_high_s16(tmp_gx.val[0])));</div><div class="line"><a name="l00499"></a><span class="lineno"> 499</span>  float32x4_t high_gy = vcvtq_f32_s32(vmovl_s16(vget_high_s16(tmp_gy.val[0])));</div><div class="line"><a name="l00500"></a><span class="lineno"> 500</span>  harris_score1x5_FLOAT_FLOAT_FLOAT(low_gx, low_gy, high_gx, high_gy, gx2.val[0], gy2.val[0], gxgy.val[0], norm_factor);</div><div class="line"><a name="l00501"></a><span class="lineno"> 501</span> </div><div class="line"><a name="l00502"></a><span class="lineno"> 502</span>  low_gx = vcvtq_f32_s32(vmovl_s16(vget_low_s16(tmp_gx.val[1])));</div><div class="line"><a name="l00503"></a><span class="lineno"> 503</span>  low_gy = vcvtq_f32_s32(vmovl_s16(vget_low_s16(tmp_gy.val[1])));</div><div class="line"><a name="l00504"></a><span class="lineno"> 504</span>  high_gx = vcvtq_f32_s32(vmovl_s16(vget_high_s16(tmp_gx.val[1])));</div><div class="line"><a name="l00505"></a><span class="lineno"> 505</span>  high_gy = vcvtq_f32_s32(vmovl_s16(vget_high_s16(tmp_gy.val[1])));</div><div class="line"><a name="l00506"></a><span class="lineno"> 506</span>  harris_score1x5_FLOAT_FLOAT_FLOAT(low_gx, low_gy, high_gx, high_gy, gx2.val[1], gy2.val[1], gxgy.val[1], norm_factor);</div><div class="line"><a name="l00507"></a><span class="lineno"> 507</span> </div><div class="line"><a name="l00508"></a><span class="lineno"> 508</span>  <span class="comment">// Update gx and gy pointer</span></div><div class="line"><a name="l00509"></a><span class="lineno"> 509</span>  gx_ptr_0 += input_stride;</div><div class="line"><a name="l00510"></a><span class="lineno"> 510</span>  gy_ptr_0 += input_stride;</div><div class="line"><a name="l00511"></a><span class="lineno"> 511</span>  gx_ptr_1 += input_stride;</div><div class="line"><a name="l00512"></a><span class="lineno"> 512</span>  gy_ptr_1 += input_stride;</div><div class="line"><a name="l00513"></a><span class="lineno"> 513</span>  }</div><div class="line"><a name="l00514"></a><span class="lineno"> 514</span> </div><div class="line"><a name="l00515"></a><span class="lineno"> 515</span>  <span class="comment">// Calculate harris score</span></div><div class="line"><a name="l00516"></a><span class="lineno"> 516</span>  <span class="keyword">const</span> float32x4x2_t mc =</div><div class="line"><a name="l00517"></a><span class="lineno"> 517</span>  {</div><div class="line"><a name="l00518"></a><span class="lineno"> 518</span>  {</div><div class="line"><a name="l00519"></a><span class="lineno"> 519</span>  harris_score(gx2.val[0], gy2.val[0], gxgy.val[0], sensitivity, strength_thresh),</div><div class="line"><a name="l00520"></a><span class="lineno"> 520</span>  harris_score(gx2.val[1], gy2.val[1], gxgy.val[1], sensitivity, strength_thresh)</div><div class="line"><a name="l00521"></a><span class="lineno"> 521</span>  }</div><div class="line"><a name="l00522"></a><span class="lineno"> 522</span>  };</div><div class="line"><a name="l00523"></a><span class="lineno"> 523</span> </div><div class="line"><a name="l00524"></a><span class="lineno"> 524</span>  <span class="comment">// Store score</span></div><div class="line"><a name="l00525"></a><span class="lineno"> 525</span>  vst1q_f32(output + 0, mc.val[0]);</div><div class="line"><a name="l00526"></a><span class="lineno"> 526</span>  vst1q_f32(output + 4, mc.val[1]);</div><div class="line"><a name="l00527"></a><span class="lineno"> 527</span> }</div><div class="line"><a name="l00528"></a><span class="lineno"> 528</span> </div><div class="line"><a name="l00529"></a><span class="lineno"> 529</span> <span class="keyword">inline</span> <span class="keywordtype">void</span> harris_score5x5_S32_S32_FLOAT(<span class="keyword">const</span> <span class="keywordtype">void</span> *__restrict input1_ptr, <span class="keyword">const</span> <span class="keywordtype">void</span> *__restrict input2_ptr, <span class="keywordtype">void</span> *__restrict output_ptr, int32_t input_stride,</div><div class="line"><a name="l00530"></a><span class="lineno"> 530</span>  <span class="keywordtype">float</span> in_norm_factor, <span class="keywordtype">float</span> in_sensitivity, <span class="keywordtype">float</span> in_strength_thresh)</div><div class="line"><a name="l00531"></a><span class="lineno"> 531</span> </div><div class="line"><a name="l00532"></a><span class="lineno"> 532</span> {</div><div class="line"><a name="l00533"></a><span class="lineno"> 533</span>  <span class="keyword">auto</span> gx_ptr_0 = static_cast<const int32_t *__restrict>(input1_ptr) - 2 - 2 * input_stride;</div><div class="line"><a name="l00534"></a><span class="lineno"> 534</span>  <span class="keyword">auto</span> gy_ptr_0 = static_cast<const int32_t *__restrict>(input2_ptr) - 2 - 2 * input_stride;</div><div class="line"><a name="l00535"></a><span class="lineno"> 535</span>  <span class="keyword">const</span> int32_t *gx_ptr_1 = gx_ptr_0 + 4;</div><div class="line"><a name="l00536"></a><span class="lineno"> 536</span>  <span class="keyword">const</span> int32_t *gy_ptr_1 = gy_ptr_0 + 4;</div><div class="line"><a name="l00537"></a><span class="lineno"> 537</span>  <span class="keyword">const</span> int32_t *gx_ptr_2 = gx_ptr_0 + 8;</div><div class="line"><a name="l00538"></a><span class="lineno"> 538</span>  <span class="keyword">const</span> int32_t *gy_ptr_2 = gy_ptr_0 + 8;</div><div class="line"><a name="l00539"></a><span class="lineno"> 539</span>  <span class="keyword">const</span> <span class="keyword">auto</span> output = static_cast<float *__restrict>(output_ptr);</div><div class="line"><a name="l00540"></a><span class="lineno"> 540</span> </div><div class="line"><a name="l00541"></a><span class="lineno"> 541</span>  <span class="comment">// Gx^2, Gy^2 and Gx*Gy</span></div><div class="line"><a name="l00542"></a><span class="lineno"> 542</span>  float32x4x2_t gx2 =</div><div class="line"><a name="l00543"></a><span class="lineno"> 543</span>  {</div><div class="line"><a name="l00544"></a><span class="lineno"> 544</span>  {</div><div class="line"><a name="l00545"></a><span class="lineno"> 545</span>  vdupq_n_f32(0.0f),</div><div class="line"><a name="l00546"></a><span class="lineno"> 546</span>  vdupq_n_f32(0.0f)</div><div class="line"><a name="l00547"></a><span class="lineno"> 547</span>  }</div><div class="line"><a name="l00548"></a><span class="lineno"> 548</span>  };</div><div class="line"><a name="l00549"></a><span class="lineno"> 549</span>  float32x4x2_t gy2 =</div><div class="line"><a name="l00550"></a><span class="lineno"> 550</span>  {</div><div class="line"><a name="l00551"></a><span class="lineno"> 551</span>  {</div><div class="line"><a name="l00552"></a><span class="lineno"> 552</span>  vdupq_n_f32(0.0f),</div><div class="line"><a name="l00553"></a><span class="lineno"> 553</span>  vdupq_n_f32(0.0f)</div><div class="line"><a name="l00554"></a><span class="lineno"> 554</span>  }</div><div class="line"><a name="l00555"></a><span class="lineno"> 555</span>  };</div><div class="line"><a name="l00556"></a><span class="lineno"> 556</span>  float32x4x2_t gxgy =</div><div class="line"><a name="l00557"></a><span class="lineno"> 557</span>  {</div><div class="line"><a name="l00558"></a><span class="lineno"> 558</span>  {</div><div class="line"><a name="l00559"></a><span class="lineno"> 559</span>  vdupq_n_f32(0.0f),</div><div class="line"><a name="l00560"></a><span class="lineno"> 560</span>  vdupq_n_f32(0.0f)</div><div class="line"><a name="l00561"></a><span class="lineno"> 561</span>  }</div><div class="line"><a name="l00562"></a><span class="lineno"> 562</span>  };</div><div class="line"><a name="l00563"></a><span class="lineno"> 563</span>  float32x4_t sensitivity = vdupq_n_f32(in_sensitivity);</div><div class="line"><a name="l00564"></a><span class="lineno"> 564</span>  float32x4_t norm_factor = vdupq_n_f32(in_norm_factor);</div><div class="line"><a name="l00565"></a><span class="lineno"> 565</span>  float32x4_t strength_thresh = vdupq_n_f32(in_strength_thresh);</div><div class="line"><a name="l00566"></a><span class="lineno"> 566</span> </div><div class="line"><a name="l00567"></a><span class="lineno"> 567</span>  <span class="keywordflow">for</span>(<span class="keywordtype">int</span> i = 0; i < 5; ++i)</div><div class="line"><a name="l00568"></a><span class="lineno"> 568</span>  {</div><div class="line"><a name="l00569"></a><span class="lineno"> 569</span>  <span class="keyword">const</span> float32x4_t low_gx_0 = vcvtq_f32_s32(vld1q_s32(gx_ptr_0));</div><div class="line"><a name="l00570"></a><span class="lineno"> 570</span>  <span class="keyword">const</span> float32x4_t low_gy_0 = vcvtq_f32_s32(vld1q_s32(gy_ptr_0));</div><div class="line"><a name="l00571"></a><span class="lineno"> 571</span>  <span class="keyword">const</span> float32x4_t high_gx_0 = vcvtq_f32_s32(vld1q_s32(gx_ptr_1));</div><div class="line"><a name="l00572"></a><span class="lineno"> 572</span>  <span class="keyword">const</span> float32x4_t high_gy_0 = vcvtq_f32_s32(vld1q_s32(gy_ptr_1));</div><div class="line"><a name="l00573"></a><span class="lineno"> 573</span>  harris_score1x5_FLOAT_FLOAT_FLOAT(low_gx_0, low_gy_0, high_gx_0, high_gy_0, gx2.val[0], gy2.val[0], gxgy.val[0], norm_factor);</div><div class="line"><a name="l00574"></a><span class="lineno"> 574</span> </div><div class="line"><a name="l00575"></a><span class="lineno"> 575</span>  <span class="keyword">const</span> float32x4_t low_gx_1 = vcvtq_f32_s32(vld1q_s32(gx_ptr_1));</div><div class="line"><a name="l00576"></a><span class="lineno"> 576</span>  <span class="keyword">const</span> float32x4_t low_gy_1 = vcvtq_f32_s32(vld1q_s32(gy_ptr_1));</div><div class="line"><a name="l00577"></a><span class="lineno"> 577</span>  <span class="keyword">const</span> float32x4_t high_gx_1 = vcvtq_f32_s32(vld1q_s32(gx_ptr_2));</div><div class="line"><a name="l00578"></a><span class="lineno"> 578</span>  <span class="keyword">const</span> float32x4_t high_gy_1 = vcvtq_f32_s32(vld1q_s32(gy_ptr_2));</div><div class="line"><a name="l00579"></a><span class="lineno"> 579</span>  harris_score1x5_FLOAT_FLOAT_FLOAT(low_gx_1, low_gy_1, high_gx_1, high_gy_1, gx2.val[1], gy2.val[1], gxgy.val[1], norm_factor);</div><div class="line"><a name="l00580"></a><span class="lineno"> 580</span> </div><div class="line"><a name="l00581"></a><span class="lineno"> 581</span>  <span class="comment">// Update gx and gy pointer</span></div><div class="line"><a name="l00582"></a><span class="lineno"> 582</span>  gx_ptr_0 += input_stride;</div><div class="line"><a name="l00583"></a><span class="lineno"> 583</span>  gy_ptr_0 += input_stride;</div><div class="line"><a name="l00584"></a><span class="lineno"> 584</span>  gx_ptr_1 += input_stride;</div><div class="line"><a name="l00585"></a><span class="lineno"> 585</span>  gy_ptr_1 += input_stride;</div><div class="line"><a name="l00586"></a><span class="lineno"> 586</span>  gx_ptr_2 += input_stride;</div><div class="line"><a name="l00587"></a><span class="lineno"> 587</span>  gy_ptr_2 += input_stride;</div><div class="line"><a name="l00588"></a><span class="lineno"> 588</span>  }</div><div class="line"><a name="l00589"></a><span class="lineno"> 589</span> </div><div class="line"><a name="l00590"></a><span class="lineno"> 590</span>  <span class="comment">// Calculate harris score</span></div><div class="line"><a name="l00591"></a><span class="lineno"> 591</span>  <span class="keyword">const</span> float32x4x2_t mc =</div><div class="line"><a name="l00592"></a><span class="lineno"> 592</span>  {</div><div class="line"><a name="l00593"></a><span class="lineno"> 593</span>  {</div><div class="line"><a name="l00594"></a><span class="lineno"> 594</span>  harris_score(gx2.val[0], gy2.val[0], gxgy.val[0], sensitivity, strength_thresh),</div><div class="line"><a name="l00595"></a><span class="lineno"> 595</span>  harris_score(gx2.val[1], gy2.val[1], gxgy.val[1], sensitivity, strength_thresh)</div><div class="line"><a name="l00596"></a><span class="lineno"> 596</span>  }</div><div class="line"><a name="l00597"></a><span class="lineno"> 597</span>  };</div><div class="line"><a name="l00598"></a><span class="lineno"> 598</span> </div><div class="line"><a name="l00599"></a><span class="lineno"> 599</span>  <span class="comment">// Store score</span></div><div class="line"><a name="l00600"></a><span class="lineno"> 600</span>  vst1q_f32(output + 0, mc.val[0]);</div><div class="line"><a name="l00601"></a><span class="lineno"> 601</span>  vst1q_f32(output + 4, mc.val[1]);</div><div class="line"><a name="l00602"></a><span class="lineno"> 602</span> }</div><div class="line"><a name="l00603"></a><span class="lineno"> 603</span> </div><div class="line"><a name="l00604"></a><span class="lineno"> 604</span> <span class="keyword">inline</span> <span class="keywordtype">void</span> harris_score7x7_S16_S16_FLOAT(<span class="keyword">const</span> <span class="keywordtype">void</span> *__restrict input1_ptr, <span class="keyword">const</span> <span class="keywordtype">void</span> *__restrict input2_ptr, <span class="keywordtype">void</span> *__restrict output_ptr, int32_t input_stride,</div><div class="line"><a name="l00605"></a><span class="lineno"> 605</span>  <span class="keywordtype">float</span> in_norm_factor, <span class="keywordtype">float</span> in_sensitivity, <span class="keywordtype">float</span> in_strength_thresh)</div><div class="line"><a name="l00606"></a><span class="lineno"> 606</span> {</div><div class="line"><a name="l00607"></a><span class="lineno"> 607</span>  <span class="keyword">auto</span> gx_ptr_0 = static_cast<const int16_t *__restrict>(input1_ptr) - 3 - 3 * input_stride;</div><div class="line"><a name="l00608"></a><span class="lineno"> 608</span>  <span class="keyword">auto</span> gy_ptr_0 = static_cast<const int16_t *__restrict>(input2_ptr) - 3 - 3 * input_stride;</div><div class="line"><a name="l00609"></a><span class="lineno"> 609</span>  <span class="keyword">const</span> int16_t *gx_ptr_1 = gx_ptr_0 + 8;</div><div class="line"><a name="l00610"></a><span class="lineno"> 610</span>  <span class="keyword">const</span> int16_t *gy_ptr_1 = gy_ptr_0 + 8;</div><div class="line"><a name="l00611"></a><span class="lineno"> 611</span>  <span class="keyword">const</span> <span class="keyword">auto</span> output = static_cast<float *__restrict>(output_ptr);</div><div class="line"><a name="l00612"></a><span class="lineno"> 612</span> </div><div class="line"><a name="l00613"></a><span class="lineno"> 613</span>  <span class="comment">// Gx^2, Gy^2 and Gx*Gy</span></div><div class="line"><a name="l00614"></a><span class="lineno"> 614</span>  float32x4_t gx2 = vdupq_n_f32(0.0f);</div><div class="line"><a name="l00615"></a><span class="lineno"> 615</span>  float32x4_t gy2 = vdupq_n_f32(0.0f);</div><div class="line"><a name="l00616"></a><span class="lineno"> 616</span>  float32x4_t gxgy = vdupq_n_f32(0.0f);</div><div class="line"><a name="l00617"></a><span class="lineno"> 617</span>  float32x4_t sensitivity = vdupq_n_f32(in_sensitivity);</div><div class="line"><a name="l00618"></a><span class="lineno"> 618</span>  float32x4_t norm_factor = vdupq_n_f32(in_norm_factor);</div><div class="line"><a name="l00619"></a><span class="lineno"> 619</span>  float32x4_t strength_thresh = vdupq_n_f32(in_strength_thresh);</div><div class="line"><a name="l00620"></a><span class="lineno"> 620</span> </div><div class="line"><a name="l00621"></a><span class="lineno"> 621</span>  <span class="keywordflow">for</span>(<span class="keywordtype">int</span> i = 0; i < 7; ++i)</div><div class="line"><a name="l00622"></a><span class="lineno"> 622</span>  {</div><div class="line"><a name="l00623"></a><span class="lineno"> 623</span>  <span class="keyword">const</span> int16x8_t tmp0_gx = vld1q_s16(gx_ptr_0);</div><div class="line"><a name="l00624"></a><span class="lineno"> 624</span>  <span class="keyword">const</span> int16x8_t tmp0_gy = vld1q_s16(gy_ptr_0);</div><div class="line"><a name="l00625"></a><span class="lineno"> 625</span>  <span class="keyword">const</span> int16x4_t tmp1_gx = vld1_s16(gx_ptr_1);</div><div class="line"><a name="l00626"></a><span class="lineno"> 626</span>  <span class="keyword">const</span> int16x4_t tmp1_gy = vld1_s16(gy_ptr_1);</div><div class="line"><a name="l00627"></a><span class="lineno"> 627</span> </div><div class="line"><a name="l00628"></a><span class="lineno"> 628</span>  float32x4_t low_gx = vcvtq_f32_s32(vmovl_s16(vget_low_s16(tmp0_gx)));</div><div class="line"><a name="l00629"></a><span class="lineno"> 629</span>  float32x4_t low_gy = vcvtq_f32_s32(vmovl_s16(vget_low_s16(tmp0_gy)));</div><div class="line"><a name="l00630"></a><span class="lineno"> 630</span>  float32x4_t high_gx = vcvtq_f32_s32(vmovl_s16(vget_high_s16(tmp0_gx)));</div><div class="line"><a name="l00631"></a><span class="lineno"> 631</span>  float32x4_t high_gy = vcvtq_f32_s32(vmovl_s16(vget_high_s16(tmp0_gy)));</div><div class="line"><a name="l00632"></a><span class="lineno"> 632</span>  float32x4_t high_gx1 = vcvtq_f32_s32(vmovl_s16(tmp1_gx));</div><div class="line"><a name="l00633"></a><span class="lineno"> 633</span>  float32x4_t high_gy1 = vcvtq_f32_s32(vmovl_s16(tmp1_gy));</div><div class="line"><a name="l00634"></a><span class="lineno"> 634</span>  harris_score1x7_FLOAT_FLOAT_FLOAT(low_gx, low_gy, high_gx, high_gy, high_gx1, high_gy1, gx2, gy2, gxgy, norm_factor);</div><div class="line"><a name="l00635"></a><span class="lineno"> 635</span> </div><div class="line"><a name="l00636"></a><span class="lineno"> 636</span>  <span class="comment">// Update gx and gy pointer</span></div><div class="line"><a name="l00637"></a><span class="lineno"> 637</span>  gx_ptr_0 += input_stride;</div><div class="line"><a name="l00638"></a><span class="lineno"> 638</span>  gy_ptr_0 += input_stride;</div><div class="line"><a name="l00639"></a><span class="lineno"> 639</span>  gx_ptr_1 += input_stride;</div><div class="line"><a name="l00640"></a><span class="lineno"> 640</span>  gy_ptr_1 += input_stride;</div><div class="line"><a name="l00641"></a><span class="lineno"> 641</span>  }</div><div class="line"><a name="l00642"></a><span class="lineno"> 642</span> </div><div class="line"><a name="l00643"></a><span class="lineno"> 643</span>  <span class="comment">// Calculate harris score</span></div><div class="line"><a name="l00644"></a><span class="lineno"> 644</span>  <span class="keyword">const</span> float32x4_t mc = harris_score(gx2, gy2, gxgy, sensitivity, strength_thresh);</div><div class="line"><a name="l00645"></a><span class="lineno"> 645</span> </div><div class="line"><a name="l00646"></a><span class="lineno"> 646</span>  <span class="comment">// Store score</span></div><div class="line"><a name="l00647"></a><span class="lineno"> 647</span>  vst1q_f32(output, mc);</div><div class="line"><a name="l00648"></a><span class="lineno"> 648</span> }</div><div class="line"><a name="l00649"></a><span class="lineno"> 649</span> </div><div class="line"><a name="l00650"></a><span class="lineno"> 650</span> <span class="keyword">inline</span> <span class="keywordtype">void</span> harris_score7x7_S32_S32_FLOAT(<span class="keyword">const</span> <span class="keywordtype">void</span> *__restrict input1_ptr, <span class="keyword">const</span> <span class="keywordtype">void</span> *__restrict input2_ptr, <span class="keywordtype">void</span> *__restrict output_ptr, int32_t input_stride,</div><div class="line"><a name="l00651"></a><span class="lineno"> 651</span>  <span class="keywordtype">float</span> in_norm_factor, <span class="keywordtype">float</span> in_sensitivity, <span class="keywordtype">float</span> in_strength_thresh)</div><div class="line"><a name="l00652"></a><span class="lineno"> 652</span> {</div><div class="line"><a name="l00653"></a><span class="lineno"> 653</span>  <span class="keyword">auto</span> gx_ptr_0 = static_cast<const int32_t *__restrict>(input1_ptr) - 3 - 3 * input_stride;</div><div class="line"><a name="l00654"></a><span class="lineno"> 654</span>  <span class="keyword">auto</span> gy_ptr_0 = static_cast<const int32_t *__restrict>(input2_ptr) - 3 - 3 * input_stride;</div><div class="line"><a name="l00655"></a><span class="lineno"> 655</span>  <span class="keyword">const</span> int32_t *gx_ptr_1 = gx_ptr_0 + 4;</div><div class="line"><a name="l00656"></a><span class="lineno"> 656</span>  <span class="keyword">const</span> int32_t *gy_ptr_1 = gy_ptr_0 + 4;</div><div class="line"><a name="l00657"></a><span class="lineno"> 657</span>  <span class="keyword">const</span> int32_t *gx_ptr_2 = gx_ptr_1 + 4;</div><div class="line"><a name="l00658"></a><span class="lineno"> 658</span>  <span class="keyword">const</span> int32_t *gy_ptr_2 = gy_ptr_1 + 4;</div><div class="line"><a name="l00659"></a><span class="lineno"> 659</span>  <span class="keyword">const</span> <span class="keyword">auto</span> output = static_cast<float *__restrict>(output_ptr);</div><div class="line"><a name="l00660"></a><span class="lineno"> 660</span> </div><div class="line"><a name="l00661"></a><span class="lineno"> 661</span>  <span class="comment">// Gx^2, Gy^2 and Gx*Gy</span></div><div class="line"><a name="l00662"></a><span class="lineno"> 662</span>  float32x4_t gx2 = vdupq_n_f32(0.0f);</div><div class="line"><a name="l00663"></a><span class="lineno"> 663</span>  float32x4_t gy2 = vdupq_n_f32(0.0f);</div><div class="line"><a name="l00664"></a><span class="lineno"> 664</span>  float32x4_t gxgy = vdupq_n_f32(0.0f);</div><div class="line"><a name="l00665"></a><span class="lineno"> 665</span>  float32x4_t sensitivity = vdupq_n_f32(in_sensitivity);</div><div class="line"><a name="l00666"></a><span class="lineno"> 666</span>  float32x4_t norm_factor = vdupq_n_f32(in_norm_factor);</div><div class="line"><a name="l00667"></a><span class="lineno"> 667</span>  float32x4_t strength_thresh = vdupq_n_f32(in_strength_thresh);</div><div class="line"><a name="l00668"></a><span class="lineno"> 668</span> </div><div class="line"><a name="l00669"></a><span class="lineno"> 669</span>  <span class="keywordflow">for</span>(<span class="keywordtype">int</span> i = 0; i < 7; ++i)</div><div class="line"><a name="l00670"></a><span class="lineno"> 670</span>  {</div><div class="line"><a name="l00671"></a><span class="lineno"> 671</span>  <span class="keyword">const</span> float32x4_t low_gx = vcvtq_f32_s32(vld1q_s32(gx_ptr_0));</div><div class="line"><a name="l00672"></a><span class="lineno"> 672</span>  <span class="keyword">const</span> float32x4_t low_gy = vcvtq_f32_s32(vld1q_s32(gy_ptr_0));</div><div class="line"><a name="l00673"></a><span class="lineno"> 673</span>  <span class="keyword">const</span> float32x4_t high_gx = vcvtq_f32_s32(vld1q_s32(gx_ptr_1));</div><div class="line"><a name="l00674"></a><span class="lineno"> 674</span>  <span class="keyword">const</span> float32x4_t high_gy = vcvtq_f32_s32(vld1q_s32(gy_ptr_1));</div><div class="line"><a name="l00675"></a><span class="lineno"> 675</span>  <span class="keyword">const</span> float32x4_t high_gx1 = vcvtq_f32_s32(vld1q_s32(gx_ptr_2));</div><div class="line"><a name="l00676"></a><span class="lineno"> 676</span>  <span class="keyword">const</span> float32x4_t high_gy1 = vcvtq_f32_s32(vld1q_s32(gy_ptr_2));</div><div class="line"><a name="l00677"></a><span class="lineno"> 677</span>  harris_score1x7_FLOAT_FLOAT_FLOAT(low_gx, low_gy, high_gx, high_gy, high_gx1, high_gy1, gx2, gy2, gxgy, norm_factor);</div><div class="line"><a name="l00678"></a><span class="lineno"> 678</span> </div><div class="line"><a name="l00679"></a><span class="lineno"> 679</span>  <span class="comment">// Update gx and gy pointer</span></div><div class="line"><a name="l00680"></a><span class="lineno"> 680</span>  gx_ptr_0 += input_stride;</div><div class="line"><a name="l00681"></a><span class="lineno"> 681</span>  gy_ptr_0 += input_stride;</div><div class="line"><a name="l00682"></a><span class="lineno"> 682</span>  gx_ptr_1 += input_stride;</div><div class="line"><a name="l00683"></a><span class="lineno"> 683</span>  gy_ptr_1 += input_stride;</div><div class="line"><a name="l00684"></a><span class="lineno"> 684</span>  gx_ptr_2 += input_stride;</div><div class="line"><a name="l00685"></a><span class="lineno"> 685</span>  gy_ptr_2 += input_stride;</div><div class="line"><a name="l00686"></a><span class="lineno"> 686</span>  }</div><div class="line"><a name="l00687"></a><span class="lineno"> 687</span> </div><div class="line"><a name="l00688"></a><span class="lineno"> 688</span>  <span class="comment">// Calculate harris score</span></div><div class="line"><a name="l00689"></a><span class="lineno"> 689</span>  <span class="keyword">const</span> float32x4_t mc = harris_score(gx2, gy2, gxgy, sensitivity, strength_thresh);</div><div class="line"><a name="l00690"></a><span class="lineno"> 690</span> </div><div class="line"><a name="l00691"></a><span class="lineno"> 691</span>  <span class="comment">// Store score</span></div><div class="line"><a name="l00692"></a><span class="lineno"> 692</span>  vst1q_f32(output, mc);</div><div class="line"><a name="l00693"></a><span class="lineno"> 693</span> }</div><div class="line"><a name="l00694"></a><span class="lineno"> 694</span> </div><div class="line"><a name="l00695"></a><span class="lineno"> 695</span> } <span class="comment">// namespace</span></div><div class="line"><a name="l00696"></a><span class="lineno"> 696</span> </div><div class="line"><a name="l00697"></a><span class="lineno"><a class="line" href="classarm__compute_1_1_i_n_e_harris_score_kernel.xhtml#a3ad624d38793ed654c8ecb01466412ce"> 697</a></span> <a class="code" href="classarm__compute_1_1_i_n_e_harris_score_kernel.xhtml#a3ad624d38793ed654c8ecb01466412ce">INEHarrisScoreKernel::INEHarrisScoreKernel</a>()</div><div class="line"><a name="l00698"></a><span class="lineno"> 698</span>  : _input1(nullptr), _input2(nullptr), _output(nullptr), _sensitivity(0.0f), _strength_thresh(0.0f), _norm_factor(0.0f), _border_size()</div><div class="line"><a name="l00699"></a><span class="lineno"> 699</span> {</div><div class="line"><a name="l00700"></a><span class="lineno"> 700</span> }</div><div class="line"><a name="l00701"></a><span class="lineno"> 701</span> </div><div class="line"><a name="l00702"></a><span class="lineno"> 702</span> <span class="keyword">template</span> <<span class="keywordtype">int</span>32_t block_size></div><div class="line"><a name="l00703"></a><span class="lineno"><a class="line" href="classarm__compute_1_1_n_e_harris_score_kernel.xhtml#a18cf8876acac9c6c2b35e38d9beabe9d"> 703</a></span> <a class="code" href="classarm__compute_1_1_n_e_harris_score_kernel.xhtml#a18cf8876acac9c6c2b35e38d9beabe9d">NEHarrisScoreKernel<block_size>::NEHarrisScoreKernel</a>()</div><div class="line"><a name="l00704"></a><span class="lineno"> 704</span>  : <a class="code" href="classarm__compute_1_1_i_n_e_harris_score_kernel.xhtml">INEHarrisScoreKernel</a>(), _func(nullptr)</div><div class="line"><a name="l00705"></a><span class="lineno"> 705</span> {</div><div class="line"><a name="l00706"></a><span class="lineno"> 706</span> }</div><div class="line"><a name="l00707"></a><span class="lineno"> 707</span> </div><div class="line"><a name="l00708"></a><span class="lineno"> 708</span> <span class="keyword">template</span> <<span class="keywordtype">int</span>32_t block_size></div><div class="line"><a name="l00709"></a><span class="lineno"><a class="line" href="classarm__compute_1_1_n_e_harris_score_kernel.xhtml#a112b35dd205c62ea6ed1447ef226da82"> 709</a></span> <span class="keywordtype">void</span> <a class="code" href="classarm__compute_1_1_n_e_harris_score_kernel.xhtml#a112b35dd205c62ea6ed1447ef226da82">NEHarrisScoreKernel<block_size>::run</a>(<span class="keyword">const</span> <a class="code" href="classarm__compute_1_1_window.xhtml">Window</a> &window, <span class="keyword">const</span> <a class="code" href="structarm__compute_1_1_thread_info.xhtml">ThreadInfo</a> &<a class="code" href="namespacearm__compute_1_1test_1_1validation.xhtml#a4f4125dba5283887b34f889b1c615c0c">info</a>)</div><div class="line"><a name="l00710"></a><span class="lineno"> 710</span> {</div><div class="line"><a name="l00711"></a><span class="lineno"> 711</span>  <a class="code" href="_error_8h.xhtml#a6dc630a6ae9cc063b3924bcea8dee9d6">ARM_COMPUTE_UNUSED</a>(<a class="code" href="namespacearm__compute_1_1test_1_1validation.xhtml#a4f4125dba5283887b34f889b1c615c0c">info</a>);</div><div class="line"><a name="l00712"></a><span class="lineno"> 712</span>  <a class="code" href="_validate_8h.xhtml#a1b35b0d258183cf9ef36adf684d0b88c">ARM_COMPUTE_ERROR_ON_UNCONFIGURED_KERNEL</a>(<span class="keyword">this</span>);</div><div class="line"><a name="l00713"></a><span class="lineno"> 713</span>  <a class="code" href="_validate_8h.xhtml#a6eb9ce82815fe429250189da7592ba75">ARM_COMPUTE_ERROR_ON_INVALID_SUBWINDOW</a>(<a class="code" href="classarm__compute_1_1_i_kernel.xhtml#ad34a46f53686c12a5c5e717cc9617fb6">INEKernel::window</a>(), window);</div><div class="line"><a name="l00714"></a><span class="lineno"> 714</span>  <a class="code" href="_error_8h.xhtml#a54a6080c9f4df1f908e57a9bbb46f5da">ARM_COMPUTE_ERROR_ON</a>(_func == <span class="keyword">nullptr</span>);</div><div class="line"><a name="l00715"></a><span class="lineno"> 715</span> </div><div class="line"><a name="l00716"></a><span class="lineno"> 716</span>  <a class="code" href="classarm__compute_1_1_iterator.xhtml">Iterator</a> input1(_input1, window);</div><div class="line"><a name="l00717"></a><span class="lineno"> 717</span>  <a class="code" href="classarm__compute_1_1_iterator.xhtml">Iterator</a> input2(_input2, window);</div><div class="line"><a name="l00718"></a><span class="lineno"> 718</span>  <a class="code" href="classarm__compute_1_1_iterator.xhtml">Iterator</a> output(_output, window);</div><div class="line"><a name="l00719"></a><span class="lineno"> 719</span> </div><div class="line"><a name="l00720"></a><span class="lineno"> 720</span>  <span class="keyword">const</span> <span class="keywordtype">size_t</span> input_stride = _input1->info()->strides_in_bytes()[1] / <a class="code" href="namespacearm__compute.xhtml#a34b06c0cd94808a77b697e79880b84b0">element_size_from_data_type</a>(_input1->info()->data_type());</div><div class="line"><a name="l00721"></a><span class="lineno"> 721</span> </div><div class="line"><a name="l00722"></a><span class="lineno"> 722</span>  <a class="code" href="namespacearm__compute.xhtml#a5002bf7ec46d52971f9526e94172cfee">execute_window_loop</a>(window, [&](<span class="keyword">const</span> <a class="code" href="classarm__compute_1_1_coordinates.xhtml">Coordinates</a> &)</div><div class="line"><a name="l00723"></a><span class="lineno"> 723</span>  {</div><div class="line"><a name="l00724"></a><span class="lineno"> 724</span>  (*_func)(input1.<a class="code" href="classarm__compute_1_1_iterator.xhtml#ab260e292b1df3944bc1d55a9b2301e41">ptr</a>(), input2.<a class="code" href="classarm__compute_1_1_iterator.xhtml#ab260e292b1df3944bc1d55a9b2301e41">ptr</a>(), output.<a class="code" href="classarm__compute_1_1_iterator.xhtml#ab260e292b1df3944bc1d55a9b2301e41">ptr</a>(), input_stride, _norm_factor, _sensitivity, _strength_thresh);</div><div class="line"><a name="l00725"></a><span class="lineno"> 725</span>  },</div><div class="line"><a name="l00726"></a><span class="lineno"> 726</span>  input1, input2, output);</div><div class="line"><a name="l00727"></a><span class="lineno"> 727</span> }</div><div class="line"><a name="l00728"></a><span class="lineno"> 728</span> </div><div class="line"><a name="l00729"></a><span class="lineno"> 729</span> <span class="keyword">template</span> <<span class="keywordtype">int</span>32_t block_size></div><div class="line"><a name="l00730"></a><span class="lineno"><a class="line" href="classarm__compute_1_1_n_e_harris_score_kernel.xhtml#a423f9a45a52983b4de5e2b347f4369c7"> 730</a></span> <a class="code" href="structarm__compute_1_1_border_size.xhtml">BorderSize</a> <a class="code" href="classarm__compute_1_1_n_e_harris_score_kernel.xhtml#a423f9a45a52983b4de5e2b347f4369c7">NEHarrisScoreKernel<block_size>::border_size</a>()<span class="keyword"> const</span></div><div class="line"><a name="l00731"></a><span class="lineno"> 731</span> <span class="keyword"></span>{</div><div class="line"><a name="l00732"></a><span class="lineno"> 732</span>  <span class="keywordflow">return</span> _border_size;</div><div class="line"><a name="l00733"></a><span class="lineno"> 733</span> }</div><div class="line"><a name="l00734"></a><span class="lineno"> 734</span> </div><div class="line"><a name="l00735"></a><span class="lineno"> 735</span> <span class="keyword">template</span> <<span class="keywordtype">int</span>32_t block_size></div><div class="line"><a name="l00736"></a><span class="lineno"><a class="line" href="classarm__compute_1_1_n_e_harris_score_kernel.xhtml#ae3278fce9a66ca7603efcb367e6b3816"> 736</a></span> <span class="keywordtype">void</span> <a class="code" href="classarm__compute_1_1_n_e_harris_score_kernel.xhtml#ae3278fce9a66ca7603efcb367e6b3816">NEHarrisScoreKernel<block_size>::configure</a>(<span class="keyword">const</span> <a class="code" href="classarm__compute_1_1_i_tensor.xhtml">IImage</a> *input1, <span class="keyword">const</span> <a class="code" href="classarm__compute_1_1_i_tensor.xhtml">IImage</a> *input2, <a class="code" href="classarm__compute_1_1_i_tensor.xhtml">IImage</a> *output, <span class="keywordtype">float</span> norm_factor, <span class="keywordtype">float</span> strength_thresh, <span class="keywordtype">float</span> sensitivity,</div><div class="line"><a name="l00737"></a><span class="lineno"> 737</span>  <span class="keywordtype">bool</span> border_undefined)</div><div class="line"><a name="l00738"></a><span class="lineno"> 738</span> {</div><div class="line"><a name="l00739"></a><span class="lineno"> 739</span>  <a class="code" href="_validate_8h.xhtml#abbd63a8040ec1e44308da1d3be3732ae">ARM_COMPUTE_ERROR_ON_TENSOR_NOT_2D</a>(input1);</div><div class="line"><a name="l00740"></a><span class="lineno"> 740</span>  <a class="code" href="_validate_8h.xhtml#abbd63a8040ec1e44308da1d3be3732ae">ARM_COMPUTE_ERROR_ON_TENSOR_NOT_2D</a>(input2);</div><div class="line"><a name="l00741"></a><span class="lineno"> 741</span>  <a class="code" href="_validate_8h.xhtml#abbd63a8040ec1e44308da1d3be3732ae">ARM_COMPUTE_ERROR_ON_TENSOR_NOT_2D</a>(output);</div><div class="line"><a name="l00742"></a><span class="lineno"> 742</span>  <a class="code" href="_validate_8h.xhtml#aadf5c9cff86327b96d88d04649d9715e">ARM_COMPUTE_ERROR_ON_DATA_TYPE_CHANNEL_NOT_IN</a>(input1, 1, <a class="code" href="namespacearm__compute.xhtml#ab4e88c89b3b7ea1735996cc4def22d58a6e0b0886efb94aec797f6b830329b72c">DataType::S16</a>, <a class="code" href="namespacearm__compute.xhtml#ab4e88c89b3b7ea1735996cc4def22d58aa1e28eee0339658d39a8b4d325b56e9c">DataType::S32</a>);</div><div class="line"><a name="l00743"></a><span class="lineno"> 743</span>  <a class="code" href="_validate_8h.xhtml#aadf5c9cff86327b96d88d04649d9715e">ARM_COMPUTE_ERROR_ON_DATA_TYPE_CHANNEL_NOT_IN</a>(input2, 1, <a class="code" href="namespacearm__compute.xhtml#ab4e88c89b3b7ea1735996cc4def22d58a6e0b0886efb94aec797f6b830329b72c">DataType::S16</a>, <a class="code" href="namespacearm__compute.xhtml#ab4e88c89b3b7ea1735996cc4def22d58aa1e28eee0339658d39a8b4d325b56e9c">DataType::S32</a>);</div><div class="line"><a name="l00744"></a><span class="lineno"> 744</span>  <a class="code" href="_validate_8h.xhtml#aadf5c9cff86327b96d88d04649d9715e">ARM_COMPUTE_ERROR_ON_DATA_TYPE_CHANNEL_NOT_IN</a>(output, 1, <a class="code" href="namespacearm__compute.xhtml#ab4e88c89b3b7ea1735996cc4def22d58a44ad4ef5a76e6aa6fb3e3fa079a54fda">DataType::F32</a>);</div><div class="line"><a name="l00745"></a><span class="lineno"> 745</span>  <a class="code" href="_validate_8h.xhtml#a5befbfaf6bc224eabc58b5e88b1de6d1">ARM_COMPUTE_ERROR_ON_MISMATCHING_DATA_TYPES</a>(input1, input2);</div><div class="line"><a name="l00746"></a><span class="lineno"> 746</span>  <a class="code" href="_error_8h.xhtml#a54a6080c9f4df1f908e57a9bbb46f5da">ARM_COMPUTE_ERROR_ON</a>(0.0f == norm_factor);</div><div class="line"><a name="l00747"></a><span class="lineno"> 747</span> </div><div class="line"><a name="l00748"></a><span class="lineno"> 748</span>  _input1 = input1;</div><div class="line"><a name="l00749"></a><span class="lineno"> 749</span>  _input2 = input2;</div><div class="line"><a name="l00750"></a><span class="lineno"> 750</span>  _output = output;</div><div class="line"><a name="l00751"></a><span class="lineno"> 751</span>  _sensitivity = sensitivity;</div><div class="line"><a name="l00752"></a><span class="lineno"> 752</span>  _strength_thresh = strength_thresh;</div><div class="line"><a name="l00753"></a><span class="lineno"> 753</span>  _norm_factor = norm_factor;</div><div class="line"><a name="l00754"></a><span class="lineno"> 754</span>  _border_size = <a class="code" href="structarm__compute_1_1_border_size.xhtml">BorderSize</a>(block_size / 2);</div><div class="line"><a name="l00755"></a><span class="lineno"> 755</span> </div><div class="line"><a name="l00756"></a><span class="lineno"> 756</span>  <span class="keywordflow">if</span>(input1-><a class="code" href="classarm__compute_1_1_i_tensor.xhtml#a0e95dc1e53c361348314873b168ae237">info</a>()-><a class="code" href="classarm__compute_1_1_i_tensor_info.xhtml#a7cfb31af63202568efef5214acfbf3ba">data_type</a>() == <a class="code" href="namespacearm__compute.xhtml#ab4e88c89b3b7ea1735996cc4def22d58a6e0b0886efb94aec797f6b830329b72c">DataType::S16</a>)</div><div class="line"><a name="l00757"></a><span class="lineno"> 757</span>  {</div><div class="line"><a name="l00758"></a><span class="lineno"> 758</span>  <span class="keywordflow">switch</span>(block_size)</div><div class="line"><a name="l00759"></a><span class="lineno"> 759</span>  {</div><div class="line"><a name="l00760"></a><span class="lineno"> 760</span>  <span class="keywordflow">case</span> 3:</div><div class="line"><a name="l00761"></a><span class="lineno"> 761</span>  _func = &harris_score3x3_S16_S16_FLOAT;</div><div class="line"><a name="l00762"></a><span class="lineno"> 762</span>  <span class="keywordflow">break</span>;</div><div class="line"><a name="l00763"></a><span class="lineno"> 763</span>  <span class="keywordflow">case</span> 5:</div><div class="line"><a name="l00764"></a><span class="lineno"> 764</span>  _func = &harris_score5x5_S16_S16_FLOAT;</div><div class="line"><a name="l00765"></a><span class="lineno"> 765</span>  <span class="keywordflow">break</span>;</div><div class="line"><a name="l00766"></a><span class="lineno"> 766</span>  <span class="keywordflow">case</span> 7:</div><div class="line"><a name="l00767"></a><span class="lineno"> 767</span>  _func = &harris_score7x7_S16_S16_FLOAT;</div><div class="line"><a name="l00768"></a><span class="lineno"> 768</span>  <span class="keywordflow">break</span>;</div><div class="line"><a name="l00769"></a><span class="lineno"> 769</span>  <span class="keywordflow">default</span>:</div><div class="line"><a name="l00770"></a><span class="lineno"> 770</span>  <a class="code" href="_error_8h.xhtml#a05b19c75afe9c24200a62b9724734bbd">ARM_COMPUTE_ERROR</a>(<span class="stringliteral">"Invalid block size"</span>);</div><div class="line"><a name="l00771"></a><span class="lineno"> 771</span>  <span class="keywordflow">break</span>;</div><div class="line"><a name="l00772"></a><span class="lineno"> 772</span>  }</div><div class="line"><a name="l00773"></a><span class="lineno"> 773</span>  }</div><div class="line"><a name="l00774"></a><span class="lineno"> 774</span>  <span class="keywordflow">else</span></div><div class="line"><a name="l00775"></a><span class="lineno"> 775</span>  {</div><div class="line"><a name="l00776"></a><span class="lineno"> 776</span>  <span class="keywordflow">switch</span>(block_size)</div><div class="line"><a name="l00777"></a><span class="lineno"> 777</span>  {</div><div class="line"><a name="l00778"></a><span class="lineno"> 778</span>  <span class="keywordflow">case</span> 3:</div><div class="line"><a name="l00779"></a><span class="lineno"> 779</span>  _func = &harris_score3x3_S32_S32_FLOAT;</div><div class="line"><a name="l00780"></a><span class="lineno"> 780</span>  <span class="keywordflow">break</span>;</div><div class="line"><a name="l00781"></a><span class="lineno"> 781</span>  <span class="keywordflow">case</span> 5:</div><div class="line"><a name="l00782"></a><span class="lineno"> 782</span>  _func = &harris_score5x5_S32_S32_FLOAT;</div><div class="line"><a name="l00783"></a><span class="lineno"> 783</span>  <span class="keywordflow">break</span>;</div><div class="line"><a name="l00784"></a><span class="lineno"> 784</span>  <span class="keywordflow">case</span> 7:</div><div class="line"><a name="l00785"></a><span class="lineno"> 785</span>  _func = &harris_score7x7_S32_S32_FLOAT;</div><div class="line"><a name="l00786"></a><span class="lineno"> 786</span>  <span class="keywordflow">break</span>;</div><div class="line"><a name="l00787"></a><span class="lineno"> 787</span>  <span class="keywordflow">default</span>:</div><div class="line"><a name="l00788"></a><span class="lineno"> 788</span>  <a class="code" href="_error_8h.xhtml#a05b19c75afe9c24200a62b9724734bbd">ARM_COMPUTE_ERROR</a>(<span class="stringliteral">"Invalid block size"</span>);</div><div class="line"><a name="l00789"></a><span class="lineno"> 789</span>  <span class="keywordflow">break</span>;</div><div class="line"><a name="l00790"></a><span class="lineno"> 790</span>  }</div><div class="line"><a name="l00791"></a><span class="lineno"> 791</span>  }</div><div class="line"><a name="l00792"></a><span class="lineno"> 792</span> </div><div class="line"><a name="l00793"></a><span class="lineno"> 793</span>  <a class="code" href="_error_8h.xhtml#a54a6080c9f4df1f908e57a9bbb46f5da">ARM_COMPUTE_ERROR_ON</a>(<span class="keyword">nullptr</span> == _func);</div><div class="line"><a name="l00794"></a><span class="lineno"> 794</span> </div><div class="line"><a name="l00795"></a><span class="lineno"> 795</span>  constexpr <span class="keywordtype">unsigned</span> <span class="keywordtype">int</span> num_elems_processed_per_iteration = block_size != 7 ? 8 : 4;</div><div class="line"><a name="l00796"></a><span class="lineno"> 796</span>  constexpr <span class="keywordtype">unsigned</span> <span class="keywordtype">int</span> num_elems_read_per_iteration = block_size != 7 ? 16 : 12;</div><div class="line"><a name="l00797"></a><span class="lineno"> 797</span>  constexpr <span class="keywordtype">unsigned</span> <span class="keywordtype">int</span> num_elems_written_per_iteration = block_size != 7 ? 8 : 4;</div><div class="line"><a name="l00798"></a><span class="lineno"> 798</span>  constexpr <span class="keywordtype">unsigned</span> <span class="keywordtype">int</span> num_rows_read_per_iteration = block_size;</div><div class="line"><a name="l00799"></a><span class="lineno"> 799</span> </div><div class="line"><a name="l00800"></a><span class="lineno"> 800</span>  <span class="comment">// Configure kernel window</span></div><div class="line"><a name="l00801"></a><span class="lineno"> 801</span>  <a class="code" href="classarm__compute_1_1_window.xhtml">Window</a> win = <a class="code" href="namespacearm__compute.xhtml#ab7980fa5ee693e3282a76da047a1c3b5">calculate_max_window</a>(*input1-><a class="code" href="classarm__compute_1_1_i_tensor.xhtml#a0e95dc1e53c361348314873b168ae237">info</a>(), <a class="code" href="classarm__compute_1_1_steps.xhtml">Steps</a>(num_elems_processed_per_iteration), border_undefined, border_size());</div><div class="line"><a name="l00802"></a><span class="lineno"> 802</span>  <a class="code" href="classarm__compute_1_1_access_window_horizontal.xhtml">AccessWindowHorizontal</a> output_access(output-><a class="code" href="classarm__compute_1_1_i_tensor.xhtml#a0e95dc1e53c361348314873b168ae237">info</a>(), 0, num_elems_written_per_iteration);</div><div class="line"><a name="l00803"></a><span class="lineno"> 803</span> </div><div class="line"><a name="l00804"></a><span class="lineno"> 804</span>  <a class="code" href="namespacearm__compute.xhtml#afc4bd8e872567d9c4c57d89eb0bb3da1">update_window_and_padding</a>(win,</div><div class="line"><a name="l00805"></a><span class="lineno"> 805</span>  <a class="code" href="classarm__compute_1_1_access_window_rectangle.xhtml">AccessWindowRectangle</a>(input1-><a class="code" href="classarm__compute_1_1_i_tensor.xhtml#a0e95dc1e53c361348314873b168ae237">info</a>(), -_border_size.left, -_border_size.top, num_elems_read_per_iteration, num_rows_read_per_iteration),</div><div class="line"><a name="l00806"></a><span class="lineno"> 806</span>  <a class="code" href="classarm__compute_1_1_access_window_rectangle.xhtml">AccessWindowRectangle</a>(input2-><a class="code" href="classarm__compute_1_1_i_tensor.xhtml#a0e95dc1e53c361348314873b168ae237">info</a>(), -_border_size.left, -_border_size.top, num_elems_read_per_iteration, num_rows_read_per_iteration),</div><div class="line"><a name="l00807"></a><span class="lineno"> 807</span>  output_access);</div><div class="line"><a name="l00808"></a><span class="lineno"> 808</span> </div><div class="line"><a name="l00809"></a><span class="lineno"> 809</span>  <a class="code" href="structarm__compute_1_1_valid_region.xhtml">ValidRegion</a> <a class="code" href="namespacearm__compute_1_1test_1_1validation.xhtml#a7819bcbbf45c2e7c1396a137dce54422">valid_region</a> = <a class="code" href="namespacearm__compute.xhtml#aa7510e92de273e0457ce12218f712ad4">intersect_valid_regions</a>(input1-><a class="code" href="classarm__compute_1_1_i_tensor.xhtml#a0e95dc1e53c361348314873b168ae237">info</a>()-><a class="code" href="classarm__compute_1_1_i_tensor_info.xhtml#a74dfd07380a290c34fe7c8e065029b95">valid_region</a>(),</div><div class="line"><a name="l00810"></a><span class="lineno"> 810</span>  input2-><a class="code" href="classarm__compute_1_1_i_tensor.xhtml#a0e95dc1e53c361348314873b168ae237">info</a>()-><a class="code" href="classarm__compute_1_1_i_tensor_info.xhtml#a74dfd07380a290c34fe7c8e065029b95">valid_region</a>());</div><div class="line"><a name="l00811"></a><span class="lineno"> 811</span> </div><div class="line"><a name="l00812"></a><span class="lineno"> 812</span>  output_access.set_valid_region(win, <a class="code" href="namespacearm__compute_1_1test_1_1validation.xhtml#a7819bcbbf45c2e7c1396a137dce54422">valid_region</a>, border_undefined, border_size());</div><div class="line"><a name="l00813"></a><span class="lineno"> 813</span> </div><div class="line"><a name="l00814"></a><span class="lineno"> 814</span>  INEKernel::configure(win);</div><div class="line"><a name="l00815"></a><span class="lineno"> 815</span> }</div><div class="ttc" id="_error_8h_xhtml_a05b19c75afe9c24200a62b9724734bbd"><div class="ttname"><a href="_error_8h.xhtml#a05b19c75afe9c24200a62b9724734bbd">ARM_COMPUTE_ERROR</a></div><div class="ttdeci">#define ARM_COMPUTE_ERROR(...)</div><div class="ttdoc">Print the given message then throw an std::runtime_error.</div><div class="ttdef"><b>Definition:</b> <a href="_error_8h_source.xhtml#l00261">Error.h:261</a></div></div> |