| /* |
| * Copyright (c) 2021 Stephanos Ioannidis <root@stephanos.io> |
| * Copyright (C) 2010-2021 ARM Limited or its affiliates. All rights reserved. |
| * |
| * SPDX-License-Identifier: Apache-2.0 |
| */ |
| |
| #include <zephyr/ztest.h> |
| #include <zephyr/kernel.h> |
| #include <stdlib.h> |
| #include <arm_math.h> |
| #include "../../common/test_common.h" |
| |
| #include "unary_q15.pat" |
| |
| #define SNR_ERROR_THRESH ((float32_t)70) |
| #define ABS_ERROR_THRESH_Q15 ((q15_t)4) |
| #define ABS_ERROR_THRESH_Q63 ((q63_t)(1 << 16)) |
| |
| #define NUM_MATRICES (ARRAY_SIZE(in_dims) / 2) |
| #define MAX_MATRIX_DIM (40) |
| |
| #define OP2_ADD (0) |
| #define OP2_SUB (1) |
| #define OP1_SCALE (0) |
| #define OP1_TRANS (1) |
| #define OP2V_VEC_MULT (0) |
| #define OP1C_CMPLX_TRANS (0) |
| |
| static void test_op2(int op, const q15_t *ref, size_t length) |
| { |
| size_t index; |
| uint16_t *dims = (uint16_t *)in_dims; |
| q15_t *tmp1, *tmp2, *output; |
| uint16_t rows, columns; |
| arm_status status; |
| |
| arm_matrix_instance_q15 mat_in1; |
| arm_matrix_instance_q15 mat_in2; |
| arm_matrix_instance_q15 mat_out; |
| |
| /* Allocate buffers */ |
| tmp1 = malloc(MAX_MATRIX_DIM * MAX_MATRIX_DIM * sizeof(q15_t)); |
| zassert_not_null(tmp1, ASSERT_MSG_BUFFER_ALLOC_FAILED); |
| |
| tmp2 = malloc(MAX_MATRIX_DIM * MAX_MATRIX_DIM * sizeof(q15_t)); |
| zassert_not_null(tmp2, ASSERT_MSG_BUFFER_ALLOC_FAILED); |
| |
| output = malloc(length * sizeof(q15_t)); |
| zassert_not_null(output, ASSERT_MSG_BUFFER_ALLOC_FAILED); |
| |
| /* Initialise contexts */ |
| mat_in1.pData = tmp1; |
| mat_in2.pData = tmp2; |
| mat_out.pData = output; |
| |
| /* Iterate matrices */ |
| for (index = 0; index < NUM_MATRICES; index++) { |
| rows = *dims++; |
| columns = *dims++; |
| |
| /* Initialise matrix dimensions */ |
| mat_in1.numRows = mat_in2.numRows = mat_out.numRows = rows; |
| mat_in1.numCols = mat_in2.numCols = mat_out.numCols = columns; |
| |
| /* Load matrix data */ |
| memcpy(mat_in1.pData, in_com1, rows * columns * sizeof(q15_t)); |
| memcpy(mat_in2.pData, in_com2, rows * columns * sizeof(q15_t)); |
| |
| /* Run test function */ |
| switch (op) { |
| case OP2_ADD: |
| status = arm_mat_add_q15(&mat_in1, &mat_in2, |
| &mat_out); |
| break; |
| case OP2_SUB: |
| status = arm_mat_sub_q15(&mat_in1, &mat_in2, |
| &mat_out); |
| break; |
| default: |
| zassert_unreachable("invalid operation"); |
| } |
| |
| /* Validate status */ |
| zassert_equal(status, ARM_MATH_SUCCESS, |
| ASSERT_MSG_INCORRECT_COMP_RESULT); |
| |
| /* Increment output pointer */ |
| mat_out.pData += (rows * columns); |
| } |
| |
| /* Validate output */ |
| zassert_true( |
| test_snr_error_q15(length, output, ref, SNR_ERROR_THRESH), |
| ASSERT_MSG_SNR_LIMIT_EXCEED); |
| |
| zassert_true( |
| test_near_equal_q15(length, output, ref, ABS_ERROR_THRESH_Q15), |
| ASSERT_MSG_ABS_ERROR_LIMIT_EXCEED); |
| |
| /* Free buffers */ |
| free(tmp1); |
| free(tmp2); |
| free(output); |
| } |
| |
| DEFINE_TEST_VARIANT3(matrix_unary_q15, |
| op2, arm_mat_add_q15, OP2_ADD, |
| ref_add, ARRAY_SIZE(ref_add)); |
| DEFINE_TEST_VARIANT3(matrix_unary_q15, |
| op2, arm_mat_sub_q15, OP2_SUB, |
| ref_sub, ARRAY_SIZE(ref_sub)); |
| |
| static void test_op1(int op, const q15_t *ref, size_t length, bool transpose) |
| { |
| size_t index; |
| uint16_t *dims = (uint16_t *)in_dims; |
| q15_t *tmp1, *output; |
| uint16_t rows, columns; |
| arm_status status; |
| |
| arm_matrix_instance_q15 mat_in1; |
| arm_matrix_instance_q15 mat_out; |
| |
| /* Allocate buffers */ |
| tmp1 = malloc(MAX_MATRIX_DIM * MAX_MATRIX_DIM * sizeof(q15_t)); |
| zassert_not_null(tmp1, ASSERT_MSG_BUFFER_ALLOC_FAILED); |
| |
| output = malloc(length * sizeof(q15_t)); |
| zassert_not_null(output, ASSERT_MSG_BUFFER_ALLOC_FAILED); |
| |
| /* Initialise contexts */ |
| mat_in1.pData = tmp1; |
| mat_out.pData = output; |
| |
| /* Iterate matrices */ |
| for (index = 0; index < NUM_MATRICES; index++) { |
| rows = *dims++; |
| columns = *dims++; |
| |
| /* Initialise matrix dimensions */ |
| mat_in1.numRows = rows; |
| mat_in1.numCols = columns; |
| mat_out.numRows = transpose ? columns : rows; |
| mat_out.numCols = transpose ? rows : columns; |
| |
| /* Load matrix data */ |
| memcpy(mat_in1.pData, in_com1, rows * columns * sizeof(q15_t)); |
| |
| /* Run test function */ |
| switch (op) { |
| case OP1_SCALE: |
| status = arm_mat_scale_q15(&mat_in1, 0x4000, 0, |
| &mat_out); |
| break; |
| case OP1_TRANS: |
| status = arm_mat_trans_q15(&mat_in1, &mat_out); |
| break; |
| default: |
| zassert_unreachable("invalid operation"); |
| } |
| |
| /* Validate status */ |
| zassert_equal(status, ARM_MATH_SUCCESS, |
| ASSERT_MSG_INCORRECT_COMP_RESULT); |
| |
| /* Increment output pointer */ |
| mat_out.pData += (rows * columns); |
| } |
| |
| /* Validate output */ |
| zassert_true( |
| test_snr_error_q15(length, output, ref, SNR_ERROR_THRESH), |
| ASSERT_MSG_SNR_LIMIT_EXCEED); |
| |
| zassert_true( |
| test_near_equal_q15(length, output, ref, ABS_ERROR_THRESH_Q15), |
| ASSERT_MSG_ABS_ERROR_LIMIT_EXCEED); |
| |
| /* Free buffers */ |
| free(tmp1); |
| free(output); |
| } |
| |
| DEFINE_TEST_VARIANT4(matrix_unary_q15, |
| op1, arm_mat_scale_q15, OP1_SCALE, |
| ref_scale, ARRAY_SIZE(ref_scale), false); |
| DEFINE_TEST_VARIANT4(matrix_unary_q15, |
| op1, arm_mat_trans_q15, OP1_TRANS, |
| ref_trans, ARRAY_SIZE(ref_trans), true); |
| |
| static void test_op2v(int op, const q15_t *ref, size_t length) |
| { |
| size_t index; |
| const uint16_t *dims = in_dims; |
| q15_t *tmp1, *vec, *output_buf, *output; |
| uint16_t rows, internal; |
| |
| arm_matrix_instance_q15 mat_in1; |
| |
| /* Allocate buffers */ |
| tmp1 = malloc(MAX_MATRIX_DIM * MAX_MATRIX_DIM * sizeof(q15_t)); |
| zassert_not_null(tmp1, ASSERT_MSG_BUFFER_ALLOC_FAILED); |
| |
| vec = malloc(2 * MAX_MATRIX_DIM * sizeof(q15_t)); |
| zassert_not_null(vec, ASSERT_MSG_BUFFER_ALLOC_FAILED); |
| |
| output_buf = malloc(length * sizeof(q15_t)); |
| zassert_not_null(output_buf, ASSERT_MSG_BUFFER_ALLOC_FAILED); |
| |
| /* Initialise contexts */ |
| mat_in1.pData = tmp1; |
| output = output_buf; |
| |
| /* Iterate matrices */ |
| for (index = 0; index < NUM_MATRICES; index++) { |
| rows = *dims++; |
| internal = *dims++; |
| |
| /* Initialise matrix dimensions */ |
| mat_in1.numRows = rows; |
| mat_in1.numCols = internal; |
| |
| /* Load matrix data */ |
| memcpy(mat_in1.pData, in_com1, |
| 2 * rows * internal * sizeof(q15_t)); |
| memcpy(vec, in_vec1, 2 * internal * sizeof(q15_t)); |
| |
| /* Run test function */ |
| switch (op) { |
| case OP2V_VEC_MULT: |
| arm_mat_vec_mult_q15(&mat_in1, vec, output); |
| break; |
| default: |
| zassert_unreachable("invalid operation"); |
| } |
| |
| /* Increment output pointer */ |
| output += rows; |
| } |
| |
| /* Validate output */ |
| zassert_true( |
| test_snr_error_q15(length, output_buf, ref, SNR_ERROR_THRESH), |
| ASSERT_MSG_SNR_LIMIT_EXCEED); |
| |
| zassert_true( |
| test_near_equal_q15(length, output_buf, ref, ABS_ERROR_THRESH_Q15), |
| ASSERT_MSG_ABS_ERROR_LIMIT_EXCEED); |
| |
| /* Free buffers */ |
| free(tmp1); |
| free(vec); |
| free(output_buf); |
| } |
| |
| DEFINE_TEST_VARIANT3(matrix_unary_q15, |
| op2v, arm_mat_vec_mult_q15, OP2V_VEC_MULT, |
| ref_vec_mult, ARRAY_SIZE(ref_vec_mult)); |
| |
| static void test_op1c(int op, const q15_t *ref, size_t length, bool transpose) |
| { |
| size_t index; |
| const uint16_t *dims = in_dims; |
| q15_t *tmp1, *output; |
| uint16_t rows, columns; |
| arm_status status; |
| |
| arm_matrix_instance_q15 mat_in1; |
| arm_matrix_instance_q15 mat_out; |
| |
| /* Allocate buffers */ |
| tmp1 = malloc(2 * MAX_MATRIX_DIM * MAX_MATRIX_DIM * sizeof(q15_t)); |
| zassert_not_null(tmp1, ASSERT_MSG_BUFFER_ALLOC_FAILED); |
| |
| output = malloc(2 * length * sizeof(q15_t)); |
| zassert_not_null(output, ASSERT_MSG_BUFFER_ALLOC_FAILED); |
| |
| /* Initialise contexts */ |
| mat_in1.pData = tmp1; |
| mat_out.pData = output; |
| |
| /* Iterate matrices */ |
| for (index = 0; index < NUM_MATRICES; index++) { |
| rows = *dims++; |
| columns = *dims++; |
| |
| /* Initialise matrix dimensions */ |
| mat_in1.numRows = rows; |
| mat_in1.numCols = columns; |
| mat_out.numRows = transpose ? columns : rows; |
| mat_out.numCols = transpose ? rows : columns; |
| |
| /* Load matrix data */ |
| memcpy(mat_in1.pData, |
| in_cmplx1, 2 * rows * columns * sizeof(q15_t)); |
| |
| /* Run test function */ |
| switch (op) { |
| case OP1C_CMPLX_TRANS: |
| status = arm_mat_cmplx_trans_q15(&mat_in1, &mat_out); |
| break; |
| default: |
| zassert_unreachable("invalid operation"); |
| } |
| |
| /* Validate status */ |
| zassert_equal(status, ARM_MATH_SUCCESS, |
| ASSERT_MSG_INCORRECT_COMP_RESULT); |
| |
| /* Increment output pointer */ |
| mat_out.pData += 2 * (rows * columns); |
| } |
| |
| /* Validate output */ |
| zassert_true( |
| test_snr_error_q15(2 * length, output, ref, SNR_ERROR_THRESH), |
| ASSERT_MSG_SNR_LIMIT_EXCEED); |
| |
| zassert_true( |
| test_near_equal_q15(2 * length, output, ref, ABS_ERROR_THRESH_Q15), |
| ASSERT_MSG_ABS_ERROR_LIMIT_EXCEED); |
| |
| /* Free buffers */ |
| free(tmp1); |
| free(output); |
| } |
| |
| DEFINE_TEST_VARIANT4(matrix_unary_q15, |
| op1c, arm_mat_cmplx_trans_q15, OP1C_CMPLX_TRANS, |
| ref_cmplx_trans, ARRAY_SIZE(ref_cmplx_trans) / 2, true); |
| |
| ZTEST_SUITE(matrix_unary_q15, NULL, NULL, NULL, NULL, NULL); |