#include <stdio.h>
#include "toeplitz.h"
#include "uint16.h"


/*Function to build a Toeplitz Matrix for inputs of Unsigned Int16 datatype*/


void u16toeplitza(uint16* inp1,int size1,uint16* inp2,int size2,uint16* oup)
{
    if (inp1[0]!=inp2[0])
    {
        printf("Error!The first elements of the Vectors are not equal.");	// First element of both input vectors must be equal for Toeplitz.
        return;
    }
    int i, j;

    for(i=0;i<size1*size2;i++) oup[i] = 0;	// Initializing the output matrix with zeros.

    for (i = 0; i<size1; i++)
    {
        for (j = 0; j<size2; j++)
        {
            oup[j*size1] = inp2[j];		// Elements of the second input vector are copied to the first row of the Toeplitx Matrix.
        }
        oup[i] = inp1[i];			// Elements of the first input vector are copied to the first column of the Toeplitx Matrix.
    }
    for (i = size2+1; i<size1*size2; i++)	// Loop to build the rest of the Toeplitz matrix.
    {
        if (oup[i] == 0)
        oup[i] = oup[i-size2-1];
    }
}