// Tencent is pleased to support the open source community by making ncnn available. // // Copyright (C) 2022 THL A29 Limited, a Tencent company. All rights reserved. // // Licensed under the BSD 3-Clause License (the "License"); you may not use this file except // in compliance with the License. You may obtain a copy of the License at // // https://opensource.org/licenses/BSD-3-Clause // // Unless required by applicable law or agreed to in writing, software distributed // under the License is distributed on an "AS IS" BASIS, WITHOUT WARRANTIES OR // CONDITIONS OF ANY KIND, either express or implied. See the License for the // specific language governing permissions and limitations under the License. #include "binaryop_arm.h" #include #if __ARM_NEON #include #include "neon_mathfun.h" #endif // __ARM_NEON namespace ncnn { #if __ARM_FEATURE_FP16_VECTOR_ARITHMETIC template static void binary_op_vector_no_broadcast_fp16s(const __fp16* ptr, const __fp16* ptr1, __fp16* outptr, int size) { const Op op; int i = 0; for (; i + 7 < size; i += 8) { float16x8_t _p = vld1q_f16(ptr); float16x8_t _b = vld1q_f16(ptr1); float16x8_t _outp = op(_p, _b); vst1q_f16(outptr, _outp); ptr += 8; ptr1 += 8; outptr += 8; } for (; i + 3 < size; i += 4) { float16x4_t _p = vld1_f16(ptr); float16x4_t _b = vld1_f16(ptr1); float16x4_t _outp = op(_p, _b); vst1_f16(outptr, _outp); ptr += 4; ptr1 += 4; outptr += 4; } for (; i < size; i++) { *outptr = op(*ptr, *ptr1); ptr += 1; ptr1 += 1; outptr += 1; } } template static void binary_op_vector_broadcast_b_fp16s(const __fp16* ptr, const __fp16* ptr1, __fp16* outptr, int size, int elempack) { const Op op; const __fp16 b = *ptr1; int i = 0; float16x4_t _b_128 = (elempack == 4) ? vld1_f16(ptr1) : vdup_n_f16(b); float16x8_t _b_256 = (elempack == 8) ? vld1q_f16(ptr1) : vcombine_f16(_b_128, _b_128); for (; i + 7 < size; i += 8) { float16x8_t _p = vld1q_f16(ptr); float16x8_t _outp = op(_p, _b_256); vst1q_f16(outptr, _outp); ptr += 8; outptr += 8; } for (; i + 3 < size; i += 4) { float16x4_t _p = vld1_f16(ptr); float16x4_t _outp = op(_p, _b_128); vst1_f16(outptr, _outp); ptr += 4; outptr += 4; } for (; i < size; i++) { *outptr = op(*ptr, b); ptr += 1; outptr += 1; } } template static void binary_op_vector_broadcast_a_fp16s(const __fp16* ptr, const __fp16* ptr1, __fp16* outptr, int size, int elempack) { const Op op; const __fp16 a = *ptr; int i = 0; float16x4_t _a_128 = (elempack == 4) ? vld1_f16(ptr) : vdup_n_f16(a); float16x8_t _a_256 = (elempack == 8) ? vld1q_f16(ptr) : vcombine_f16(_a_128, _a_128); for (; i + 7 < size; i += 8) { float16x8_t _b = vld1q_f16(ptr1); float16x8_t _outp = op(_a_256, _b); vst1q_f16(outptr, _outp); ptr1 += 8; outptr += 8; } for (; i + 3 < size; i += 4) { float16x4_t _b = vld1_f16(ptr1); float16x4_t _outp = op(_a_128, _b); vst1_f16(outptr, _outp); ptr1 += 4; outptr += 4; } for (; i < size; i++) { *outptr = op(a, *ptr1); ptr1 += 1; outptr += 1; } } template static void binary_op_vector_broadcast_pb_fp16s(const __fp16* ptr, const __fp16* ptr1, __fp16* outptr, int w, int elempack) { const Op op; if (elempack == 8) { int i = 0; for (; i < w; i++) { float16x8_t _p = vld1q_f16(ptr); float16x8_t _b = vdupq_n_f16(*ptr1); float16x8_t _outp = op(_p, _b); vst1q_f16(outptr, _outp); ptr += 8; ptr1 += 1; outptr += 8; } } if (elempack == 4) { int i = 0; for (; i + 1 < w; i += 2) { float16x8_t _p = vld1q_f16(ptr); float16x4_t _b0 = vdup_n_f16(ptr1[0]); float16x4_t _b1 = vdup_n_f16(ptr1[1]); float16x8_t _b = vcombine_f16(_b0, _b1); float16x8_t _outp = op(_p, _b); vst1q_f16(outptr, _outp); ptr += 8; ptr1 += 2; outptr += 8; } for (; i < w; i++) { float16x4_t _p = vld1_f16(ptr); float16x4_t _b = vdup_n_f16(*ptr1); float16x4_t _outp = op(_p, _b); vst1_f16(outptr, _outp); ptr += 4; ptr1 += 1; outptr += 4; } } } template static void binary_op_vector_broadcast_pb_b_fp16s(const __fp16* ptr, const __fp16* ptr1, __fp16* outptr, int w, int elempack) { const Op op; const int size = w * elempack; int i = 0; float16x8_t _b = vdupq_n_f16(*ptr1); for (; i + 7 < size; i += 8) { float16x8_t _p = vld1q_f16(ptr); float16x8_t _outp = op(_p, _b); vst1q_f16(outptr, _outp); ptr += 8; outptr += 8; } for (; i + 3 < size; i += 4) { float16x4_t _p = vld1_f16(ptr); float16x4_t _outp = op(_p, vget_low_f16(_b)); vst1_f16(outptr, _outp); ptr += 4; outptr += 4; } } template static void binary_op_vector_broadcast_pb_a_fp16s(const __fp16* ptr, const __fp16* ptr1, __fp16* outptr, int w, int elempack) { const Op op; if (elempack == 8) { int i = 0; float16x8_t _p = vld1q_f16(ptr); for (; i < w; i++) { float16x8_t _b = vdupq_n_f16(*ptr1); float16x8_t _outp = op(_p, _b); vst1q_f16(outptr, _outp); ptr1 += 1; outptr += 8; } } if (elempack == 4) { int i = 0; float16x4_t _p0 = vld1_f16(ptr); float16x8_t _p = vcombine_f16(_p0, _p0); for (; i + 1 < w; i += 2) { float16x4_t _b0 = vdup_n_f16(ptr1[0]); float16x4_t _b1 = vdup_n_f16(ptr1[1]); float16x8_t _b = vcombine_f16(_b0, _b1); float16x8_t _outp = op(_p, _b); vst1q_f16(outptr, _outp); ptr1 += 2; outptr += 8; } for (; i < w; i++) { float16x4_t _b = vdup_n_f16(*ptr1); float16x4_t _outp = op(_p0, _b); vst1_f16(outptr, _outp); ptr1 += 1; outptr += 4; } } } template static void binary_op_vector_fp16s(const __fp16* ptr, const __fp16* ptr1, __fp16* outptr, int aw, int bw, int ap, int bp) { const int w = std::max(aw, bw); const int elempack = std::max(ap, bp); const int size = w * elempack; if (ap == bp) { if (aw == bw) { // no broadcast return binary_op_vector_no_broadcast_fp16s(ptr, ptr1, outptr, size); } if (bw == 1) { // broadcast single b return binary_op_vector_broadcast_b_fp16s(ptr, ptr1, outptr, size, elempack); } if (aw == 1) { // broadcast single a return binary_op_vector_broadcast_a_fp16s(ptr, ptr1, outptr, size, elempack); } } if (bp == 1) { if (aw == bw) { // broadcast pack1 b return binary_op_vector_broadcast_pb_fp16s(ptr, ptr1, outptr, w, elempack); } if (bw == 1) { // broadcast pack1 single b return binary_op_vector_broadcast_pb_b_fp16s(ptr, ptr1, outptr, w, elempack); } if (aw == 1) { // broadcast single a and pack1 b return binary_op_vector_broadcast_pb_a_fp16s(ptr, ptr1, outptr, w, elempack); } } // shall never reach here } namespace BinaryOp_arm_functor { #define MAKE_FUNCTION(NAME, IMPL, IMPL4, IMPL8) \ struct NAME \ { \ __fp16 operator()(const __fp16& x, const __fp16& y) const \ { \ return IMPL; \ } \ float16x4_t operator()(const float16x4_t& x, const float16x4_t& y) const \ { \ return IMPL4; \ } \ float16x8_t operator()(const float16x8_t& x, const float16x8_t& y) const \ { \ return IMPL8; \ } \ }; // clang-format off // *INDENT-OFF* MAKE_FUNCTION(binary_op_add_fp16s, x + y, vadd_f16(x, y), vaddq_f16(x, y)) MAKE_FUNCTION(binary_op_sub_fp16s, x - y, vsub_f16(x, y), vsubq_f16(x, y)) MAKE_FUNCTION(binary_op_mul_fp16s, x * y, vmul_f16(x, y), vmulq_f16(x, y)) MAKE_FUNCTION(binary_op_div_fp16s, x / y, vdiv_f16(x, y), vdivq_f16(x, y)) MAKE_FUNCTION(binary_op_max_fp16s, std::max(x, y), vmax_f16(x, y), vmaxq_f16(x, y)) MAKE_FUNCTION(binary_op_min_fp16s, std::min(x, y), vmin_f16(x, y), vminq_f16(x, y)) MAKE_FUNCTION(binary_op_pow_fp16s, (__fp16)powf(x, y), vcvt_f16_f32(pow_ps(vcvt_f32_f16(x), vcvt_f32_f16(y))), vcombine_f16(vcvt_f16_f32(pow_ps(vcvt_f32_f16(vget_low_f16(x)), vcvt_f32_f16(vget_low_f16(y)))), vcvt_f16_f32(pow_ps(vcvt_f32_f16(vget_high_f16(x)), vcvt_f32_f16(vget_high_f16(y)))))) MAKE_FUNCTION(binary_op_rsub_fp16s, y - x, vsub_f16(y, x), vsubq_f16(y, x)) MAKE_FUNCTION(binary_op_rdiv_fp16s, y / x, vdiv_f16(y, x), vdivq_f16(y, x)) MAKE_FUNCTION(binary_op_rpow_fp16s, (__fp16)powf(y, x), vcvt_f16_f32(pow_ps(vcvt_f32_f16(y), vcvt_f32_f16(x))), vcombine_f16(vcvt_f16_f32(pow_ps(vcvt_f32_f16(vget_low_f16(y)), vcvt_f32_f16(vget_low_f16(x)))), vcvt_f16_f32(pow_ps(vcvt_f32_f16(vget_high_f16(y)), vcvt_f32_f16(vget_high_f16(x)))))) MAKE_FUNCTION(binary_op_atan2_fp16s, (__fp16)atan2f(x, y), vcvt_f16_f32(atan2_ps(vcvt_f32_f16(x), vcvt_f32_f16(y))), vcombine_f16(vcvt_f16_f32(atan2_ps(vcvt_f32_f16(vget_low_f16(x)), vcvt_f32_f16(vget_low_f16(y)))), vcvt_f16_f32(atan2_ps(vcvt_f32_f16(vget_high_f16(x)), vcvt_f32_f16(vget_high_f16(y)))))) MAKE_FUNCTION(binary_op_ratan2_fp16s, (__fp16)atan2f(y, x), vcvt_f16_f32(atan2_ps(vcvt_f32_f16(y), vcvt_f32_f16(x))), vcombine_f16(vcvt_f16_f32(atan2_ps(vcvt_f32_f16(vget_low_f16(y)), vcvt_f32_f16(vget_low_f16(x)))), vcvt_f16_f32(atan2_ps(vcvt_f32_f16(vget_high_f16(y)), vcvt_f32_f16(vget_high_f16(x)))))) // *INDENT-ON* // clang-format on #undef MAKE_FUNCTION } // namespace BinaryOp_arm_functor static void binary_op_vector_fp16s(const __fp16* ptr, const __fp16* ptr1, __fp16* outptr, int aw, int bw, int ap, int bp, int op_type) { using namespace BinaryOp_arm_functor; if (op_type == BinaryOp::Operation_ADD) return binary_op_vector_fp16s(ptr, ptr1, outptr, aw, bw, ap, bp); if (op_type == BinaryOp::Operation_SUB) return binary_op_vector_fp16s(ptr, ptr1, outptr, aw, bw, ap, bp); if (op_type == BinaryOp::Operation_MUL) return binary_op_vector_fp16s(ptr, ptr1, outptr, aw, bw, ap, bp); if (op_type == BinaryOp::Operation_DIV) return binary_op_vector_fp16s(ptr, ptr1, outptr, aw, bw, ap, bp); if (op_type == BinaryOp::Operation_MAX) return binary_op_vector_fp16s(ptr, ptr1, outptr, aw, bw, ap, bp); if (op_type == BinaryOp::Operation_MIN) return binary_op_vector_fp16s(ptr, ptr1, outptr, aw, bw, ap, bp); if (op_type == BinaryOp::Operation_POW) return binary_op_vector_fp16s(ptr, ptr1, outptr, aw, bw, ap, bp); if (op_type == BinaryOp::Operation_RSUB) return binary_op_vector_fp16s(ptr, ptr1, outptr, aw, bw, ap, bp); if (op_type == BinaryOp::Operation_RDIV) return binary_op_vector_fp16s(ptr, ptr1, outptr, aw, bw, ap, bp); if (op_type == BinaryOp::Operation_RPOW) return binary_op_vector_fp16s(ptr, ptr1, outptr, aw, bw, ap, bp); if (op_type == BinaryOp::Operation_ATAN2) return binary_op_vector_fp16s(ptr, ptr1, outptr, aw, bw, ap, bp); if (op_type == BinaryOp::Operation_RATAN2) return binary_op_vector_fp16s(ptr, ptr1, outptr, aw, bw, ap, bp); // should never reach here } static void binary_op_scalar_fp16s(const Mat& a, __fp16 b, Mat& c, int op_type, const Option& opt) { const int channels = a.c; const int size = a.w * a.h * a.d * a.elempack; #pragma omp parallel for num_threads(opt.num_threads) for (int q = 0; q < channels; q++) { const __fp16* ptr = a.channel(q); __fp16* outptr = c.channel(q); binary_op_vector_fp16s(ptr, &b, outptr, size, 1, 1, 1, op_type); } } static void binary_op_no_broadcast_fp16s(const Mat& a, const Mat& b, Mat& c, int op_type, const Option& opt) { const int channels = a.c; const int size = a.w * a.h * a.d * a.elempack; #pragma omp parallel for num_threads(opt.num_threads) for (int q = 0; q < channels; q++) { const __fp16* ptr = a.channel(q); const __fp16* ptr1 = b.channel(q); __fp16* outptr = c.channel(q); binary_op_vector_fp16s(ptr, ptr1, outptr, size, size, 1, 1, op_type); } } static void binary_op_broadcast_fp16s(const Mat& a, const Mat& b, Mat& c, int op_type, const Option& opt) { if (b.w * b.h * b.d * b.c * b.elempack == 1) { return binary_op_scalar_fp16s(a, ((const __fp16*)b)[0], c, op_type, opt); } if (a.dims == b.dims && a.w == b.w && a.h == b.h && a.d == b.d && a.c == b.c && a.elempack == b.elempack) { return binary_op_no_broadcast_fp16s(a, b, c, op_type, opt); } const int dims = c.dims; if (dims == 2) { const int h = c.h; #pragma omp parallel for num_threads(opt.num_threads) for (int y = 0; y < h; y++) { const int y0 = std::min(y, a.h - 1); const int y1 = std::min(y, b.h - 1); const __fp16* ptr = a.row(y0); const __fp16* ptr1 = b.row(y1); __fp16* outptr = c.row<__fp16>(y); binary_op_vector_fp16s(ptr, ptr1, outptr, a.w, b.w, a.elempack, b.elempack, op_type); } } if (dims == 3 || dims == 4) { const int channels = c.c; #pragma omp parallel for num_threads(opt.num_threads) for (int q = 0; q < channels; q++) { const int q0 = std::min(q, a.c - 1); const int q1 = std::min(q, b.c - 1); if (b.d * b.h * b.w == 1) { const __fp16* ptr = a.channel(q0); const __fp16* ptr1 = b.channel(q1); __fp16* outptr = c.channel(q); binary_op_vector_fp16s(ptr, ptr1, outptr, a.w * a.h * a.d, 1, a.elempack, b.elempack, op_type); continue; } if (b.h * b.w == 1) { for (int z = 0; z < c.d; z++) { const int z0 = std::min(z, a.d - 1); const int z1 = std::min(z, b.d - 1); const __fp16* ptr = a.channel(q0).depth(z0); const __fp16* ptr1 = b.channel(q1).depth(z1); __fp16* outptr = c.channel(q).depth(z); binary_op_vector_fp16s(ptr, ptr1, outptr, a.w * a.h, 1, a.elempack, b.elempack, op_type); } continue; } for (int z = 0; z < c.d; z++) { const int z0 = std::min(z, a.d - 1); const int z1 = std::min(z, b.d - 1); for (int y = 0; y < c.h; y++) { const int y0 = std::min(y, a.h - 1); const int y1 = std::min(y, b.h - 1); const __fp16* ptr = a.channel(q0).depth(z0).row(y0); const __fp16* ptr1 = b.channel(q1).depth(z1).row(y1); __fp16* outptr = c.channel(q).depth(z).row<__fp16>(y); binary_op_vector_fp16s(ptr, ptr1, outptr, a.w, b.w, a.elempack, b.elempack, op_type); } } } } } static void binary_op_scalar_inplace_fp16s(Mat& a, __fp16 b, int op_type, const Option& opt) { const int channels = a.c; const int size = a.w * a.h * a.d * a.elempack; #pragma omp parallel for num_threads(opt.num_threads) for (int q = 0; q < channels; q++) { __fp16* ptr = a.channel(q); binary_op_vector_fp16s(ptr, &b, ptr, size, 1, 1, 1, op_type); } } static int get_reverse_op_type(int op_type) { if (op_type == BinaryOp::Operation_SUB) return BinaryOp::Operation_RSUB; if (op_type == BinaryOp::Operation_DIV) return BinaryOp::Operation_RDIV; if (op_type == BinaryOp::Operation_POW) return BinaryOp::Operation_RPOW; if (op_type == BinaryOp::Operation_ATAN2) return BinaryOp::Operation_RATAN2; if (op_type == BinaryOp::Operation_RSUB) return BinaryOp::Operation_SUB; if (op_type == BinaryOp::Operation_RDIV) return BinaryOp::Operation_DIV; if (op_type == BinaryOp::Operation_RPOW) return BinaryOp::Operation_POW; if (op_type == BinaryOp::Operation_RATAN2) return BinaryOp::Operation_ATAN2; return op_type; } int BinaryOp_arm::forward_fp16s(const std::vector& bottom_blobs, std::vector& top_blobs, const Option& opt) const { const Mat& A = bottom_blobs[0]; const Mat& B = bottom_blobs[1]; const int outdims = std::max(A.dims, B.dims); Mat A2 = A; Mat B2 = B; if (A.dims < outdims) { // expand inner axes if (outdims == 2) { if (A.w * A.elempack == B.h * B.elempack) A2 = A.reshape(1, A.w, opt.workspace_allocator); else // if (A.w == B.w) { A2.dims = 2; A2.w = A.w * A.elempack; A2.elempack = 1; A2.elemsize = A.elemsize / A.elempack; A2.cstep = A2.w; } } if (outdims == 3 && A.dims == 1) { if (A.w * A.elempack == B.c * B.elempack) A2 = A.reshape(1, 1, A.w, opt.workspace_allocator); else // if (A.w == B.w) { A2.dims = 3; A2.w = A.w * A.elempack; A2.elempack = 1; A2.elemsize = A.elemsize / A.elempack; A2.cstep = A2.w; } } if (outdims == 3 && A.dims == 2) A2 = A.reshape(1, A.w, A.h, opt.workspace_allocator); if (outdims == 4 && A.dims == 1) { if (A.w * A.elempack == B.c * B.elempack) A2 = A.reshape(1, 1, 1, A.w, opt.workspace_allocator); else // if (A.w == B.w) { A2.dims = 4; A2.w = A.w * A.elempack; A2.elempack = 1; A2.elemsize = A.elemsize / A.elempack; A2.cstep = A2.w; } } if (outdims == 4 && A.dims == 2) A2 = A.reshape(1, 1, A.w, A.h, opt.workspace_allocator); if (outdims == 4 && A.dims == 3) A2 = A.reshape(1, A.w, A.h, A.c, opt.workspace_allocator); } if (B.dims < outdims) { // expand inner axes if (outdims == 2) { if (B.w * B.elempack == A.h * A.elempack) B2 = B.reshape(1, B.w, opt.workspace_allocator); else // if (B.w == A.w) { B2.dims = 2; B2.w = B.w * B.elempack; B2.elempack = 1; B2.elemsize = B.elemsize / B.elempack; B2.cstep = B2.w; } } if (outdims == 3 && B.dims == 1) { if (B.w * B.elempack == A.c * A.elempack) B2 = B.reshape(1, 1, B.w, opt.workspace_allocator); else // if (B.w == A.w) { B2.dims = 3; B2.w = B.w * B.elempack; B2.elempack = 1; B2.elemsize = B.elemsize / B.elempack; B2.cstep = B2.w; } } if (outdims == 3 && B.dims == 2) B2 = B.reshape(1, B.w, B.h, opt.workspace_allocator); if (outdims == 4 && B.dims == 1) { if (B.w * B.elempack == A.c * A.elempack) B2 = B.reshape(1, 1, 1, B.w, opt.workspace_allocator); else // if (B.w == A.w) { B2.dims = 4; B2.w = B.w * B.elempack; B2.elempack = 1; B2.elemsize = B.elemsize / B.elempack; B2.cstep = B2.w; } } if (outdims == 4 && B.dims == 2) B2 = B.reshape(1, 1, B.w, B.h, opt.workspace_allocator); if (outdims == 4 && B.dims == 3) B2 = B.reshape(1, B.w, B.h, B.c, opt.workspace_allocator); } const int outw = std::max(A2.w, B2.w); const int outh = std::max(A2.h, B2.h); const int outd = std::max(A2.d, B2.d); const int outc = std::max(A2.c, B2.c); const size_t out_elemsize = std::max(A2.elemsize, B2.elemsize); const int out_elempack = std::max(A2.elempack, B2.elempack); Mat& top_blob = top_blobs[0]; if (outdims == 1) { top_blob.create(outw, out_elemsize, out_elempack, opt.blob_allocator); } if (outdims == 2) { top_blob.create(outw, outh, out_elemsize, out_elempack, opt.blob_allocator); } if (outdims == 3) { top_blob.create(outw, outh, outc, out_elemsize, out_elempack, opt.blob_allocator); } if (outdims == 4) { top_blob.create(outw, outh, outd, outc, out_elemsize, out_elempack, opt.blob_allocator); } if (top_blob.empty()) return -100; const bool a_pack_is_lower = A2.elempack < B2.elempack; const bool a_pack_is_equal = A2.elempack == B2.elempack; const bool a_size_is_lower = A2.w * A2.h * A2.d * A2.c * A2.elempack < B2.w * B2.h * B2.d * B2.c * B2.elempack; if (a_pack_is_lower || (a_pack_is_equal && a_size_is_lower)) { binary_op_broadcast_fp16s(B2, A2, top_blob, get_reverse_op_type(op_type), opt); } else { binary_op_broadcast_fp16s(A2, B2, top_blob, op_type, opt); } return 0; } int BinaryOp_arm::forward_inplace_fp16s(Mat& bottom_top_blob, const Option& opt) const { binary_op_scalar_inplace_fp16s(bottom_top_blob, b, op_type, opt); return 0; } #endif // __ARM_FEATURE_FP16_VECTOR_ARITHMETIC } // namespace ncnn