Anthony Barbier | 6ff3b19 | 2017-09-04 18:44:23 +0100 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (c) 2017 ARM Limited. |
| 3 | * |
| 4 | * SPDX-License-Identifier: MIT |
| 5 | * |
| 6 | * Permission is hereby granted, free of charge, to any person obtaining a copy |
| 7 | * of this software and associated documentation files (the "Software"), to |
| 8 | * deal in the Software without restriction, including without limitation the |
| 9 | * rights to use, copy, modify, merge, publish, distribute, sublicense, and/or |
| 10 | * sell copies of the Software, and to permit persons to whom the Software is |
| 11 | * furnished to do so, subject to the following conditions: |
| 12 | * |
| 13 | * The above copyright notice and this permission notice shall be included in all |
| 14 | * copies or substantial portions of the Software. |
| 15 | * |
| 16 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
| 17 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
| 18 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE |
| 19 | * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
| 20 | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
| 21 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE |
| 22 | * SOFTWARE. |
| 23 | */ |
| 24 | #include "arm_compute/core/NEON/kernels/NERemapKernel.h" |
| 25 | |
| 26 | #include "arm_compute/core/AccessWindowStatic.h" |
| 27 | #include "arm_compute/core/Error.h" |
| 28 | #include "arm_compute/core/Helpers.h" |
| 29 | #include "arm_compute/core/ITensor.h" |
| 30 | #include "arm_compute/core/TensorInfo.h" |
| 31 | #include "arm_compute/core/Validate.h" |
| 32 | #include "arm_compute/core/Window.h" |
| 33 | |
| 34 | #include <arm_neon.h> |
| 35 | #include <cstddef> |
| 36 | #include <cstdint> |
| 37 | |
| 38 | using namespace arm_compute; |
| 39 | |
| 40 | namespace arm_compute |
| 41 | { |
| 42 | class Coordinates; |
| 43 | } // namespace arm_compute |
| 44 | |
| 45 | namespace |
| 46 | { |
| 47 | inline int32x4_t offset_nearest_interpolation(const float *mapx_ptr, const float *mapy_ptr, const float32x4_t &width, const float32x4_t &height, const int32x4_t &stride) |
| 48 | { |
| 49 | static const float32x4_t lowerxy = vdupq_n_f32(-1.0f); |
| 50 | |
| 51 | float32x4_t x = vld1q_f32(mapx_ptr); |
| 52 | float32x4_t y = vld1q_f32(mapy_ptr); |
| 53 | |
| 54 | // Clamp x coordinates |
| 55 | x = vmaxq_f32(lowerxy, vminq_f32(x, width)); |
| 56 | y = vmaxq_f32(lowerxy, vminq_f32(y, height)); |
| 57 | |
| 58 | const int32x4_t x_s32 = vcvtq_s32_f32(x); |
| 59 | const int32x4_t y_s32 = vcvtq_s32_f32(y); |
| 60 | |
| 61 | return vmlaq_s32(x_s32, y_s32, stride); |
| 62 | } |
| 63 | |
| 64 | } // namespace |
| 65 | |
| 66 | NERemapKernel::NERemapKernel() |
| 67 | : _func(nullptr), _input(nullptr), _output(nullptr), _map_x(nullptr), _map_y(nullptr) |
| 68 | { |
| 69 | } |
| 70 | |
Sanghoon Lee | fc35b51 | 2017-10-18 12:09:04 +0100 | [diff] [blame] | 71 | BorderSize NERemapKernel::border_size() const |
| 72 | { |
| 73 | return BorderSize(1); |
| 74 | } |
| 75 | |
Anthony Barbier | 6ff3b19 | 2017-09-04 18:44:23 +0100 | [diff] [blame] | 76 | void NERemapKernel::configure(const ITensor *input, const ITensor *map_x, const ITensor *map_y, ITensor *output, InterpolationPolicy policy) |
| 77 | { |
| 78 | ARM_COMPUTE_ERROR_ON_DATA_TYPE_CHANNEL_NOT_IN(input, 1, DataType::U8); |
| 79 | ARM_COMPUTE_ERROR_ON_DATA_TYPE_CHANNEL_NOT_IN(output, 1, DataType::U8); |
| 80 | ARM_COMPUTE_ERROR_ON_DATA_TYPE_CHANNEL_NOT_IN(map_x, 1, DataType::F32); |
| 81 | ARM_COMPUTE_ERROR_ON_DATA_TYPE_CHANNEL_NOT_IN(map_y, 1, DataType::F32); |
| 82 | |
| 83 | _input = input; |
| 84 | _output = output; |
| 85 | _map_x = map_x; |
| 86 | _map_y = map_y; |
| 87 | |
| 88 | switch(policy) |
| 89 | { |
| 90 | case InterpolationPolicy::NEAREST_NEIGHBOR: |
| 91 | { |
| 92 | _func = &NERemapKernel::remap_nearest; |
| 93 | break; |
| 94 | } |
| 95 | case InterpolationPolicy::BILINEAR: |
| 96 | { |
| 97 | _func = &NERemapKernel::remap_bilinear; |
| 98 | break; |
| 99 | } |
| 100 | default: |
| 101 | ARM_COMPUTE_ERROR("Unsupported interpolation mode"); |
| 102 | break; |
| 103 | } |
| 104 | |
| 105 | constexpr unsigned int num_elems_processed_per_iteration = 16; |
| 106 | |
| 107 | // Configure kernel window |
| 108 | Window win = calculate_max_window(*output->info(), Steps(num_elems_processed_per_iteration)); |
| 109 | |
Sanghoon Lee | fc35b51 | 2017-10-18 12:09:04 +0100 | [diff] [blame] | 110 | const int total_right = ceil_to_multiple(input->info()->dimension(0), num_elems_processed_per_iteration); |
| 111 | const int access_right = total_right + (((total_right - input->info()->dimension(0)) == 0) ? border_size().right : 0); |
Anthony Barbier | 6ff3b19 | 2017-09-04 18:44:23 +0100 | [diff] [blame] | 112 | |
Sanghoon Lee | fc35b51 | 2017-10-18 12:09:04 +0100 | [diff] [blame] | 113 | AccessWindowStatic input_access(input->info(), -border_size().left, -border_size().top, access_right, input->info()->dimension(1) + border_size().bottom); |
| 114 | |
| 115 | AccessWindowHorizontal output_access(output->info(), 0, num_elems_processed_per_iteration); |
| 116 | |
| 117 | update_window_and_padding(win, input_access, |
Anthony Barbier | 6ff3b19 | 2017-09-04 18:44:23 +0100 | [diff] [blame] | 118 | AccessWindowRectangle(map_x->info(), 0, 0, num_elems_processed_per_iteration, 1), |
| 119 | AccessWindowRectangle(map_y->info(), 0, 0, num_elems_processed_per_iteration, 1), |
| 120 | output_access); |
| 121 | |
Sanghoon Lee | fc35b51 | 2017-10-18 12:09:04 +0100 | [diff] [blame] | 122 | output_access.set_valid_region(win, ValidRegion(Coordinates(), output->info()->tensor_shape())); |
Anthony Barbier | 6ff3b19 | 2017-09-04 18:44:23 +0100 | [diff] [blame] | 123 | |
| 124 | INEKernel::configure(win); |
| 125 | } |
| 126 | |
| 127 | void NERemapKernel::remap_nearest(const Window &window) |
| 128 | { |
| 129 | // Don't increment in X and Y direction for the input tensor |
| 130 | // A pointer to the start of this plane is needed as base for the precomputed offsets |
| 131 | Window win_in(window); |
| 132 | win_in.set(Window::DimX, Window::Dimension(0, 0, 0)); |
| 133 | win_in.set(Window::DimY, Window::Dimension(0, 0, 0)); |
| 134 | |
| 135 | Iterator in(_input, win_in); |
| 136 | Iterator out(_output, window); |
| 137 | Iterator mapx(_map_x, window); |
| 138 | Iterator mapy(_map_y, window); |
| 139 | |
| 140 | const float32x4_t width = vdupq_n_f32(static_cast<float>(_input->info()->dimension(0))); |
| 141 | const float32x4_t height = vdupq_n_f32(static_cast<float>(_input->info()->dimension(1))); |
| 142 | const int32x4_t in_stride = vdupq_n_s32(static_cast<int32_t>(_input->info()->strides_in_bytes()[1])); |
| 143 | |
| 144 | execute_window_loop(window, [&](const Coordinates & id) |
| 145 | { |
| 146 | const auto mapx_ptr = reinterpret_cast<const float *>(mapx.ptr()); |
| 147 | const auto mapy_ptr = reinterpret_cast<const float *>(mapy.ptr()); |
| 148 | const uint8_t *in_ptr = in.ptr(); |
| 149 | |
| 150 | const int32x4_t offset0 = offset_nearest_interpolation(mapx_ptr + 0, mapy_ptr + 0, width, height, in_stride); |
| 151 | const int32x4_t offset1 = offset_nearest_interpolation(mapx_ptr + 4, mapy_ptr + 4, width, height, in_stride); |
| 152 | const int32x4_t offset2 = offset_nearest_interpolation(mapx_ptr + 8, mapy_ptr + 8, width, height, in_stride); |
| 153 | const int32x4_t offset3 = offset_nearest_interpolation(mapx_ptr + 12, mapy_ptr + 12, width, height, in_stride); |
| 154 | |
| 155 | uint8x8_t tmp0 = vdup_n_u8(0); |
| 156 | tmp0 = vset_lane_u8(in_ptr[vgetq_lane_s32(offset0, 0)], tmp0, 0); |
| 157 | tmp0 = vset_lane_u8(in_ptr[vgetq_lane_s32(offset0, 1)], tmp0, 1); |
| 158 | tmp0 = vset_lane_u8(in_ptr[vgetq_lane_s32(offset0, 2)], tmp0, 2); |
| 159 | tmp0 = vset_lane_u8(in_ptr[vgetq_lane_s32(offset0, 3)], tmp0, 3); |
| 160 | tmp0 = vset_lane_u8(in_ptr[vgetq_lane_s32(offset1, 0)], tmp0, 4); |
| 161 | tmp0 = vset_lane_u8(in_ptr[vgetq_lane_s32(offset1, 1)], tmp0, 5); |
| 162 | tmp0 = vset_lane_u8(in_ptr[vgetq_lane_s32(offset1, 2)], tmp0, 6); |
| 163 | tmp0 = vset_lane_u8(in_ptr[vgetq_lane_s32(offset1, 3)], tmp0, 7); |
| 164 | |
| 165 | uint8x8_t tmp1 = vdup_n_u8(0); |
| 166 | tmp1 = vset_lane_u8(in_ptr[vgetq_lane_s32(offset2, 0)], tmp1, 0); |
| 167 | tmp1 = vset_lane_u8(in_ptr[vgetq_lane_s32(offset2, 1)], tmp1, 1); |
| 168 | tmp1 = vset_lane_u8(in_ptr[vgetq_lane_s32(offset2, 2)], tmp1, 2); |
| 169 | tmp1 = vset_lane_u8(in_ptr[vgetq_lane_s32(offset2, 3)], tmp1, 3); |
| 170 | tmp1 = vset_lane_u8(in_ptr[vgetq_lane_s32(offset3, 0)], tmp1, 4); |
| 171 | tmp1 = vset_lane_u8(in_ptr[vgetq_lane_s32(offset3, 1)], tmp1, 5); |
| 172 | tmp1 = vset_lane_u8(in_ptr[vgetq_lane_s32(offset3, 2)], tmp1, 6); |
| 173 | tmp1 = vset_lane_u8(in_ptr[vgetq_lane_s32(offset3, 3)], tmp1, 7); |
| 174 | |
| 175 | vst1q_u8(out.ptr(), vcombine_u8(tmp0, tmp1)); |
| 176 | }, |
| 177 | in, out, mapx, mapy); |
| 178 | } |
| 179 | |
| 180 | void NERemapKernel::remap_bilinear(const Window &window) |
| 181 | { |
| 182 | // Don't increment in X and Y direction for the input tensor |
| 183 | // A pointer to the start of this plane is needed as base for the precomputed offsets |
| 184 | Window win_in(window); |
| 185 | win_in.set(Window::DimX, Window::Dimension(0, 0, 0)); |
| 186 | win_in.set(Window::DimY, Window::Dimension(0, 0, 0)); |
| 187 | |
| 188 | Iterator in(_input, win_in); |
| 189 | Iterator out(_output, window); |
| 190 | Iterator mapx(_map_x, window); |
| 191 | Iterator mapy(_map_y, window); |
| 192 | |
| 193 | const size_t width = _input->info()->dimension(0); |
| 194 | const size_t height = _input->info()->dimension(1); |
| 195 | const size_t in_stride = _input->info()->strides_in_bytes()[1]; |
| 196 | |
| 197 | execute_window_loop(window, [&](const Coordinates & id) |
| 198 | { |
| 199 | const auto mapx_ptr = reinterpret_cast<float *>(mapx.ptr()); |
| 200 | const auto mapy_ptr = reinterpret_cast<float *>(mapy.ptr()); |
| 201 | const uint8_t *in_ptr = in.ptr(); |
| 202 | |
| 203 | uint8x8_t tmp0 = vdup_n_u8(0); |
Georgios Pinitas | 583137c | 2017-08-31 18:12:42 +0100 | [diff] [blame] | 204 | tmp0 = vset_lane_u8(pixel_bilinear_c1_clamp(in_ptr, in_stride, width, height, mapx_ptr[0], mapy_ptr[0]), tmp0, 0); |
| 205 | tmp0 = vset_lane_u8(pixel_bilinear_c1_clamp(in_ptr, in_stride, width, height, mapx_ptr[1], mapy_ptr[1]), tmp0, 1); |
| 206 | tmp0 = vset_lane_u8(pixel_bilinear_c1_clamp(in_ptr, in_stride, width, height, mapx_ptr[2], mapy_ptr[2]), tmp0, 2); |
| 207 | tmp0 = vset_lane_u8(pixel_bilinear_c1_clamp(in_ptr, in_stride, width, height, mapx_ptr[3], mapy_ptr[3]), tmp0, 3); |
| 208 | tmp0 = vset_lane_u8(pixel_bilinear_c1_clamp(in_ptr, in_stride, width, height, mapx_ptr[4], mapy_ptr[4]), tmp0, 4); |
| 209 | tmp0 = vset_lane_u8(pixel_bilinear_c1_clamp(in_ptr, in_stride, width, height, mapx_ptr[5], mapy_ptr[5]), tmp0, 5); |
| 210 | tmp0 = vset_lane_u8(pixel_bilinear_c1_clamp(in_ptr, in_stride, width, height, mapx_ptr[6], mapy_ptr[6]), tmp0, 6); |
| 211 | tmp0 = vset_lane_u8(pixel_bilinear_c1_clamp(in_ptr, in_stride, width, height, mapx_ptr[7], mapy_ptr[7]), tmp0, 7); |
Anthony Barbier | 6ff3b19 | 2017-09-04 18:44:23 +0100 | [diff] [blame] | 212 | |
| 213 | uint8x8_t tmp1 = vdup_n_u8(0); |
Georgios Pinitas | 583137c | 2017-08-31 18:12:42 +0100 | [diff] [blame] | 214 | tmp1 = vset_lane_u8(pixel_bilinear_c1_clamp(in_ptr, in_stride, width, height, mapx_ptr[8], mapy_ptr[8]), tmp1, 0); |
| 215 | tmp1 = vset_lane_u8(pixel_bilinear_c1_clamp(in_ptr, in_stride, width, height, mapx_ptr[9], mapy_ptr[9]), tmp1, 1); |
| 216 | tmp1 = vset_lane_u8(pixel_bilinear_c1_clamp(in_ptr, in_stride, width, height, mapx_ptr[10], mapy_ptr[10]), tmp1, 2); |
| 217 | tmp1 = vset_lane_u8(pixel_bilinear_c1_clamp(in_ptr, in_stride, width, height, mapx_ptr[11], mapy_ptr[11]), tmp1, 3); |
| 218 | tmp1 = vset_lane_u8(pixel_bilinear_c1_clamp(in_ptr, in_stride, width, height, mapx_ptr[12], mapy_ptr[12]), tmp1, 4); |
| 219 | tmp1 = vset_lane_u8(pixel_bilinear_c1_clamp(in_ptr, in_stride, width, height, mapx_ptr[13], mapy_ptr[13]), tmp1, 5); |
| 220 | tmp1 = vset_lane_u8(pixel_bilinear_c1_clamp(in_ptr, in_stride, width, height, mapx_ptr[14], mapy_ptr[14]), tmp1, 6); |
| 221 | tmp1 = vset_lane_u8(pixel_bilinear_c1_clamp(in_ptr, in_stride, width, height, mapx_ptr[15], mapy_ptr[15]), tmp1, 7); |
Anthony Barbier | 6ff3b19 | 2017-09-04 18:44:23 +0100 | [diff] [blame] | 222 | |
| 223 | vst1q_u8(out.ptr(), vcombine_u8(tmp0, tmp1)); |
| 224 | }, |
| 225 | in, out, mapx, mapy); |
| 226 | } |
| 227 | |
Moritz Pflanzer | c186b57 | 2017-09-07 09:48:04 +0100 | [diff] [blame] | 228 | void NERemapKernel::run(const Window &window, const ThreadInfo &info) |
Anthony Barbier | 6ff3b19 | 2017-09-04 18:44:23 +0100 | [diff] [blame] | 229 | { |
Moritz Pflanzer | c186b57 | 2017-09-07 09:48:04 +0100 | [diff] [blame] | 230 | ARM_COMPUTE_UNUSED(info); |
Anthony Barbier | 6ff3b19 | 2017-09-04 18:44:23 +0100 | [diff] [blame] | 231 | ARM_COMPUTE_ERROR_ON_UNCONFIGURED_KERNEL(this); |
| 232 | ARM_COMPUTE_ERROR_ON_INVALID_SUBWINDOW(INEKernel::window(), window); |
| 233 | ARM_COMPUTE_ERROR_ON(_func == nullptr); |
| 234 | |
| 235 | (this->*_func)(window); |
| 236 | } |