Векторное сложение массивов

#include <stdlib.h>
#include <stdio.h>
 
 
#define COLS_COUNT 16
#define ARRAY_LENGTH 256
 
/**
 * Печатает массив в stdout
 * @param array - указатель на массив
 * @param length - длина массива
 */
 
 
void print_array(unsigned char *array, unsigned int length) {
    for (int i = 0; i < length;) {
        do {
 
            printf("%4.3d", array[i++]);
        } while (i % COLS_COUNT);
 
        printf("\n");
    }
}
 
/**
 * Инициализирует массив псевдослучайными числами
 * @param array - указатель на массив
 * @param length - длина массива
 */
void init_array(unsigned char *array, unsigned int length) {
    for (int i = 0; i < length; ++i) {
        array[i] = (rand() + 1) & 0xff;
    }
}
 
/**
 * Вычисляет векторную сумму двух массивов
 * @param array1 - указатель на массив 1
 * @param array2 - указатель на массив 2
 * @param dst - указатель на массив с результатами сложения
 * @param length - длина массива
 */
void kernel_vector_add(unsigned char *array1, unsigned char *array2, unsigned char *dst, unsigned int length);
 
int main() {
    unsigned char array1[ARRAY_LENGTH];
    unsigned char array2[ARRAY_LENGTH];
    unsigned char dst[ARRAY_LENGTH]= {0};
    printf("Sample 3: Vector adding arrays\n");
 
    //Инициализируем массивы псевдослучайными числами
    init_array(array1, sizeof(array1));
    init_array(array2, sizeof(array2));
 
    //Выводим исходные массивы
    printf("Source array 1:\n");
    print_array(array1, sizeof(array1));
    printf("Source array 2:\n");
    print_array(array2, sizeof(array2));
 
    //Вызываем вычислительный кернел
    kernel_vector_add(array1, array2, dst, ARRAY_LENGTH);
 
    //Выводим результат
    printf("Destination array:\n");
    print_array(dst, sizeof(dst));
 
    return 0;
}

/*
 ASM процедура, вычисляющая векторное сложение массивов
 */
 
; Объявление глобальной метки  _kernel_vector_add, которая указывает на процедуру  _kernel_vector_add
.globl _kernel_vector_add
 
.text
; Процедура  _kernel_vector_add
; Input:
; - r0: array1 - указатель на первый массив
; - r1: array2 - указатель на второй массив
; - r3: length - длинна массивов
; Output:
; - r2: dst - указатель на массив c результатами сложения
_kernel_vector_add:
    ; Сохраняем используемые векторные регистры на стек
    alframe 0xc8
    vst v0, (r13)
    vst v1, (r13 + 0x40)
    vst v2, (r13 + 0x80)
 
    ; Вычисляем количество итераций цикла (length / 64)
    lsrl  6, r3, r3
 
    ; Вычислительный цикл
    do r3, 1f
        ; Загружаем данные 2x64 byte
        vld (r0)+, v0   vld (r1)+, v1
        ; Векторно складываем загруженные данные 64х1 unsigned byte, с сатурацией
        vaddbu.sat v0, v1, v2
    1:
        ; Сохраняем результат
        vst v2, (r2)+
 
    ; Восстанавливаем сохраненные на стек регистры и выходим из процедуры
    vld (r13), v0
    vld (r13+0x40), v1
    vld (r13+0x80), v2
 
    deframer