FreeRDP/libfreerdp/primitives/prim_add.c
2024-06-08 08:34:11 +02:00

72 lines
2.0 KiB
C

/* FreeRDP: A Remote Desktop Protocol Client
* Add operations.
* vi:ts=4 sw=4:
*
* (c) Copyright 2012 Hewlett-Packard Development Company, L.P.
* 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 http://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.
*
*/
#include <freerdp/config.h>
#include <stdint.h>
#include <freerdp/types.h>
#include <freerdp/primitives.h>
#include "prim_internal.h"
/* ----------------------------------------------------------------------------
* 16-bit signed add with saturation (under and over).
*/
static pstatus_t general_add_16s(const INT16* WINPR_RESTRICT pSrc1,
const INT16* WINPR_RESTRICT pSrc2, INT16* WINPR_RESTRICT pDst,
UINT32 len)
{
while (len--)
{
INT32 k = (INT32)(*pSrc1++) + (INT32)(*pSrc2++);
if (k > INT16_MAX)
*pDst++ = ((INT16)INT16_MAX);
else if (k < INT16_MIN)
*pDst++ = ((INT16)INT16_MIN);
else
*pDst++ = (INT16)k;
}
return PRIMITIVES_SUCCESS;
}
static pstatus_t general_add_16s_inplace(INT16* WINPR_RESTRICT pSrcDst,
const INT16* WINPR_RESTRICT pSrc, UINT32 len)
{
while (len--)
{
INT32 k = (INT32)(*pSrcDst) + (INT32)(*pSrc++);
if (k > INT16_MAX)
*pSrcDst++ = ((INT16)INT16_MAX);
else if (k < INT16_MIN)
*pSrcDst++ = ((INT16)INT16_MIN);
else
*pSrcDst++ = (INT16)k;
}
return PRIMITIVES_SUCCESS;
}
/* ------------------------------------------------------------------------- */
void primitives_init_add(primitives_t* prims)
{
prims->add_16s = general_add_16s;
prims->add_16s_inplace = general_add_16s_inplace;
}