42 lines
1.8 KiB
C
42 lines
1.8 KiB
C
/******************************************************************************\
|
|
* Authors: Iconoclast *
|
|
* Release: 2013.11.26 *
|
|
* License: CC0 Public Domain Dedication *
|
|
* *
|
|
* To the extent possible under law, the author(s) have dedicated all copyright *
|
|
* and related and neighboring rights to this software to the public domain *
|
|
* worldwide. This software is distributed without any warranty. *
|
|
* *
|
|
* You should have received a copy of the CC0 Public Domain Dedication along *
|
|
* with this software. *
|
|
* If not, see <http://creativecommons.org/publicdomain/zero/1.0/>. *
|
|
\******************************************************************************/
|
|
#include "vu.h"
|
|
|
|
INLINE static void do_madh(usf_state_t * state, short* VD, short* VS, short* VT)
|
|
{
|
|
ALIGNED int32_t product[N];
|
|
ALIGNED uint32_t addend[N];
|
|
register int i;
|
|
|
|
for (i = 0; i < N; i++)
|
|
product[i] = (signed short)(VS[i]) * (signed short)(VT[i]);
|
|
for (i = 0; i < N; i++)
|
|
addend[i] = (unsigned short)(VACC_M[i]) + (unsigned short)(product[i]);
|
|
for (i = 0; i < N; i++)
|
|
VACC_M[i] += (short)(VS[i] * VT[i]);
|
|
for (i = 0; i < N; i++)
|
|
VACC_H[i] += (addend[i] >> 16) + (product[i] >> 16);
|
|
SIGNED_CLAMP_AM(state, VD);
|
|
return;
|
|
}
|
|
|
|
static void VMADH(usf_state_t * state, int vd, int vs, int vt, int e)
|
|
{
|
|
ALIGNED short ST[N];
|
|
|
|
SHUFFLE_VECTOR(ST, state->VR[vt], e);
|
|
do_madh(state, state->VR[vd], state->VR[vs], ST);
|
|
return;
|
|
}
|