| /* |
| * Copyright (C) 2020-2022 Arm Limited or its affiliates. |
| * |
| * SPDX-License-Identifier: Apache-2.0 |
| * |
| * Licensed under the Apache License, Version 2.0 (the License); you may |
| * not use this file except in compliance with the License. |
| * You may obtain a copy of the License at |
| * |
| * www.apache.org/licenses/LICENSE-2.0 |
| * |
| * 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. |
| */ |
| |
| /* ---------------------------------------------------------------------- |
| * Project: CMSIS NN Library |
| * Title: arm_nn_vec_mat_mult_t_s8 |
| * Description: s8 vector by matrix (transposed) multiplication |
| * |
| * $Date: 28 April 2022 |
| * $Revision: V.3.0.1 |
| * |
| * Target Processor: Cortex-M |
| * |
| * -------------------------------------------------------------------- */ |
| |
| #include "arm_nnsupportfunctions.h" |
| |
| /** |
| * @ingroup groupSupport |
| */ |
| |
| /** |
| * @addtogroup NNBasicMath |
| * @{ |
| */ |
| |
| /* |
| * s8 vector(lhs) by matrix (transposed) multiplication |
| * |
| * Refer header file for details. |
| * |
| */ |
| arm_status arm_nn_vec_mat_mult_t_s8(const q7_t *lhs, |
| const q7_t *rhs, |
| const q31_t *bias, |
| q7_t *dst, |
| const int32_t lhs_offset, |
| const int32_t rhs_offset, |
| const int32_t dst_offset, |
| const int32_t dst_multiplier, |
| const int32_t dst_shift, |
| const int32_t rhs_cols, |
| const int32_t rhs_rows, |
| const int32_t activation_min, |
| const int32_t activation_max, |
| const int32_t address_offset) |
| { |
| (void)rhs_offset; |
| #if defined(ARM_MATH_MVEI) |
| const int32_t row_loop_cnt = rhs_rows / 3; |
| const uint32x4_t address_offset_array = {0, address_offset, address_offset * 2, address_offset * 3}; |
| |
| for (int i_row_loop_cnt = 0; i_row_loop_cnt < row_loop_cnt; i_row_loop_cnt++) |
| { |
| int32_t acc_0 = 0; |
| int32_t acc_1 = 0; |
| int32_t acc_2 = 0; |
| |
| const int32_t col_loop_cnt = (rhs_cols + 15) / 16; |
| |
| const int8_t *lhs_vec = lhs; |
| const int8_t *rhs_0 = rhs; |
| const int8_t *rhs_1 = rhs + rhs_cols; |
| const int8_t *rhs_2 = rhs + 2 * rhs_cols; |
| |
| int32_t rhs_sum_0 = 0; |
| int32_t rhs_sum_1 = 0; |
| int32_t rhs_sum_2 = 0; |
| |
| uint32_t col_cnt = (uint32_t)rhs_cols; |
| |
| for (int i = 0; i < col_loop_cnt; i++) |
| { |
| mve_pred16_t p = vctp8q(col_cnt); |
| col_cnt -= 16; |
| |
| const int8x16_t input = vldrbq_z_s8(lhs_vec, p); |
| |
| const int8x16_t ker_0 = vldrbq_z_s8(rhs_0, p); |
| rhs_sum_0 = vaddvaq_p_s8(rhs_sum_0, ker_0, p); |
| acc_0 = vmladavaq_p_s8(acc_0, ker_0, input, p); |
| |
| const int8x16_t ker_1 = vldrbq_z_s8(rhs_1, p); |
| rhs_sum_1 = vaddvaq_p_s8(rhs_sum_1, ker_1, p); |
| acc_1 = vmladavaq_p_s8(acc_1, ker_1, input, p); |
| |
| const int8x16_t ker_2 = vldrbq_z_s8(rhs_2, p); |
| rhs_sum_2 = vaddvaq_p_s8(rhs_sum_2, ker_2, p); |
| acc_2 = vmladavaq_p_s8(acc_2, ker_2, input, p); |
| |
| lhs_vec += 16; |
| rhs_0 += 16; |
| rhs_1 += 16; |
| rhs_2 += 16; |
| } |
| rhs += 3 * rhs_cols; |
| |
| int32x4_t acc = {acc_0, acc_1, acc_2, 0}; |
| mve_pred16_t p = vctp32q(3); |
| if (bias) |
| { |
| int32x4_t b = vldrwq_z_s32(bias, p); |
| acc = vaddq_m_s32(vuninitializedq_s32(), acc, b, p); |
| bias += 3; |
| } |
| const int32x4_t rhs_sum = {rhs_sum_0, rhs_sum_1, rhs_sum_2, 0}; |
| acc += vdupq_n_s32(lhs_offset) * rhs_sum; |
| |
| acc = arm_requantize_mve(acc, dst_multiplier, dst_shift); |
| acc = vaddq_s32(acc, vdupq_n_s32(dst_offset)); |
| acc = vmaxq_s32(acc, vdupq_n_s32(activation_min)); |
| acc = vminq_s32(acc, vdupq_n_s32(activation_max)); |
| |
| if (address_offset > 1L) |
| { |
| vstrbq_scatter_offset_s32(dst, address_offset_array, acc); |
| } |
| else |
| { |
| vstrbq_p_s32(dst, acc, p); |
| } |
| dst += 3 * address_offset; |
| } |
| |
| const int loop_cnt = rhs_rows % 3; |
| for (int i_row_loop_cnt = 0; i_row_loop_cnt < loop_cnt; i_row_loop_cnt++) |
| { |
| int32_t acc_0 = 0; |
| const int32_t col_loop_cnt = (rhs_cols + 15) / 16; |
| const int8_t *lhs_vec = lhs; |
| const int8_t *rhs_0 = rhs; |
| int32_t rhs_sum_0 = 0; |
| uint32_t col_cnt = (uint32_t)rhs_cols; |
| |
| for (int i = 0; i < col_loop_cnt; i++) |
| { |
| mve_pred16_t p = vctp8q(col_cnt); |
| col_cnt -= 16; |
| const int8x16_t input = vldrbq_z_s8(lhs_vec, p); |
| |
| const int8x16_t ker_0 = vldrbq_z_s8(rhs_0, p); |
| rhs_sum_0 = vaddvaq_p_s8(rhs_sum_0, ker_0, p); |
| acc_0 = vmladavaq_p_s8(acc_0, ker_0, input, p); |
| |
| lhs_vec += 16; |
| rhs_0 += 16; |
| } |
| rhs += rhs_cols; |
| |
| if (bias) |
| { |
| acc_0 += *bias; |
| bias++; |
| } |
| const int32_t offsets = rhs_sum_0 * lhs_offset; |
| acc_0 += offsets; |
| acc_0 = arm_nn_requantize(acc_0, dst_multiplier, dst_shift); |
| acc_0 += dst_offset; |
| |
| // Clamp the result |
| acc_0 = MAX(acc_0, activation_min); |
| *dst = MIN(acc_0, activation_max); |
| dst += address_offset; |
| } |
| |
| #elif defined(ARM_MATH_DSP) |
| const int32_t row_loop_cnt = rhs_rows / 2; |
| const int16_t lhs_offset_s16 = (int16_t)lhs_offset; |
| const uint32_t lhs_offset_s16x2 = __PKHBT(lhs_offset_s16, lhs_offset_s16, 16); |
| |
| for (int32_t i = 0; i < row_loop_cnt; i++) |
| { |
| int32_t acc_0 = 0; |
| int32_t acc_1 = 0; |
| if (bias) |
| { |
| acc_0 = *bias++; |
| acc_1 = *bias++; |
| } |
| |
| const int32_t col_loop_cnt = rhs_cols / 4; |
| |
| const int8_t *lhs_vec = lhs; |
| const int8_t *rhs_0 = rhs; |
| const int8_t *rhs_1 = rhs + rhs_cols; |
| rhs += 2 * rhs_cols; |
| |
| for (int j = col_loop_cnt; j != 0; j--) |
| { |
| int32_t vec_0 = arm_nn_read_q7x4_ia(&lhs_vec); |
| int32_t vec_1 = __SXTAB16_RORn(lhs_offset_s16x2, (uint32_t)vec_0, 8); |
| |
| vec_0 = __SXTAB16(lhs_offset_s16x2, vec_0); |
| |
| int32_t ker_0 = arm_nn_read_q7x4_ia(&rhs_0); |
| int32_t ker_1 = __SXTB16_RORn((uint32_t)ker_0, 8); |
| ker_0 = __SXTB16(ker_0); |
| |
| acc_0 = __SMLAD(ker_1, vec_1, acc_0); |
| acc_0 = __SMLAD(ker_0, vec_0, acc_0); |
| |
| ker_0 = arm_nn_read_q7x4_ia(&rhs_1); |
| ker_1 = __SXTB16_RORn((uint32_t)ker_0, 8); |
| ker_0 = __SXTB16(ker_0); |
| |
| acc_1 = __SMLAD(ker_1, vec_1, acc_1); |
| acc_1 = __SMLAD(ker_0, vec_0, acc_1); |
| } |
| |
| for (int k = col_loop_cnt * 4; k < rhs_cols; k++) |
| { |
| const int32_t lhs_temp = (*lhs_vec + lhs_offset); |
| lhs_vec++; |
| acc_0 += lhs_temp * (*rhs_0); |
| rhs_0++; |
| acc_1 += lhs_temp * (*rhs_1); |
| rhs_1++; |
| } |
| |
| acc_0 = arm_nn_requantize(acc_0, dst_multiplier, dst_shift); |
| acc_1 = arm_nn_requantize(acc_1, dst_multiplier, dst_shift); |
| |
| // Add offset |
| acc_0 += dst_offset; |
| acc_1 += dst_offset; |
| // Clamp the result |
| acc_0 = MAX(acc_0, activation_min); |
| acc_0 = MIN(acc_0, activation_max); |
| acc_1 = MAX(acc_1, activation_min); |
| acc_1 = MIN(acc_1, activation_max); |
| *dst = (int8_t)acc_0; |
| *(dst + address_offset) = (int8_t)acc_1; |
| dst += 2 * address_offset; |
| } |
| |
| if (rhs_rows & 0x1) |
| { |
| int32_t acc_0 = 0; |
| if (bias) |
| { |
| acc_0 = *bias++; |
| } |
| const int32_t col_loop_cnt = rhs_cols / 4; |
| |
| const int8_t *lhs_vec = lhs; |
| const int8_t *rhs_0 = rhs; |
| |
| for (int i = col_loop_cnt; i != 0; i--) |
| { |
| int32_t vec_0 = arm_nn_read_q7x4_ia(&lhs_vec); |
| int32_t vec_1 = __SXTAB16_RORn(lhs_offset_s16x2, (uint32_t)vec_0, 8); |
| vec_0 = __SXTAB16(lhs_offset_s16x2, vec_0); |
| |
| int32_t ker_0 = arm_nn_read_q7x4_ia(&rhs_0); |
| int32_t ker_1 = __SXTB16_RORn((uint32_t)ker_0, 8); |
| ker_0 = __SXTB16(ker_0); |
| |
| acc_0 = __SMLAD(ker_1, vec_1, acc_0); |
| acc_0 = __SMLAD(ker_0, vec_0, acc_0); |
| } |
| |
| for (int j = col_loop_cnt * 4; j < rhs_cols; j++) |
| { |
| const int32_t lhs_temp = (*lhs_vec + lhs_offset); |
| lhs_vec++; |
| acc_0 += lhs_temp * (*rhs_0); |
| rhs_0++; |
| } |
| |
| acc_0 = arm_nn_requantize(acc_0, dst_multiplier, dst_shift); |
| |
| // Add offset |
| acc_0 += dst_offset; |
| // Clamp the result |
| acc_0 = MAX(acc_0, activation_min); |
| acc_0 = MIN(acc_0, activation_max); |
| *dst = (int8_t)acc_0; |
| dst += address_offset; |
| } |
| |
| #else |
| |
| const int32_t row_loop_cnt = rhs_rows / 3; |
| |
| for (int i_row_loop_cnt = 0; i_row_loop_cnt < row_loop_cnt; i_row_loop_cnt++) |
| { |
| const q7_t *lhs_ptr = lhs; |
| const q7_t *rhs_ptr_0 = &rhs[0]; |
| const q7_t *rhs_ptr_1 = &rhs[rhs_cols]; |
| const q7_t *rhs_ptr_2 = &rhs[rhs_cols * 2]; |
| |
| q31_t res00 = 0; |
| q31_t res01 = 0; |
| q31_t res02 = 0; |
| if (bias) |
| { |
| res00 = *bias++; |
| res01 = *bias++; |
| res02 = *bias++; |
| } |
| for (int32_t rhs_cols_idx = 0; rhs_cols_idx < rhs_cols; ++rhs_cols_idx) |
| { |
| const q31_t rhs_value0 = (int8_t)*rhs_ptr_0; |
| const q31_t rhs_value1 = (int8_t)*rhs_ptr_1; |
| const q31_t rhs_value2 = (int8_t)*rhs_ptr_2; |
| const q31_t lhs_value = (int8_t)*lhs_ptr + lhs_offset; |
| |
| res00 += lhs_value * rhs_value0; |
| res01 += lhs_value * rhs_value1; |
| res02 += lhs_value * rhs_value2; |
| |
| ++rhs_ptr_0; |
| ++rhs_ptr_1; |
| ++rhs_ptr_2; |
| ++lhs_ptr; |
| } |
| // Quantize down |
| res00 = arm_nn_requantize(res00, dst_multiplier, dst_shift); |
| res01 = arm_nn_requantize(res01, dst_multiplier, dst_shift); |
| res02 = arm_nn_requantize(res02, dst_multiplier, dst_shift); |
| |
| // Add offset |
| res00 += dst_offset; |
| res01 += dst_offset; |
| res02 += dst_offset; |
| |
| // Clamp the result |
| res00 = MAX(res00, activation_min); |
| res00 = MIN(res00, activation_max); |
| res01 = MAX(res01, activation_min); |
| res01 = MIN(res01, activation_max); |
| res02 = MAX(res02, activation_min); |
| res02 = MIN(res02, activation_max); |
| |
| *dst = (q7_t)res00; |
| *(dst + address_offset) = (q7_t)res01; |
| *(dst + 2 * address_offset) = (q7_t)res02; |
| dst += 3 * address_offset; |
| |
| rhs += 3 * rhs_cols; |
| } |
| |
| const int loop_cnt = rhs_rows % 3; |
| |
| for (int i_loop_cnt = 0; i_loop_cnt < loop_cnt; i_loop_cnt++) |
| { |
| const q7_t *lhs_ptr = &lhs[0]; |
| const q7_t *rhs_ptr = &rhs[0]; |
| |
| q31_t res00 = 0; |
| if (bias) |
| { |
| res00 = *bias++; |
| } |
| |
| for (int32_t rhs_cols_idx = 0; rhs_cols_idx < rhs_cols; ++rhs_cols_idx) |
| { |
| q31_t rhs_value0 = (int8_t)rhs_ptr[0]; |
| q31_t lhs_value = (int8_t)lhs_ptr[0] + lhs_offset; |
| |
| res00 += lhs_value * rhs_value0; |
| |
| ++rhs_ptr; |
| ++lhs_ptr; |
| } |
| |
| // Quantize down |
| res00 = arm_nn_requantize(res00, dst_multiplier, dst_shift); |
| |
| // Add offset |
| res00 += dst_offset; |
| |
| // Clamp the result |
| res00 = MAX(res00, activation_min); |
| res00 = MIN(res00, activation_max); |
| |
| *dst = (int8_t)res00; |
| dst += address_offset; |
| rhs += rhs_cols; |
| } |
| #endif |
| return ARM_MATH_SUCCESS; |
| } |
| |
| /** |
| * @} end of NNBasicMath group |
| */ |