diff options
author | Sebastian Huber <sebastian.huber@embedded-brains.de> | 2017-07-03 13:14:35 +0200 |
---|---|---|
committer | Sebastian Huber <sebastian.huber@embedded-brains.de> | 2017-07-06 15:29:27 +0200 |
commit | 7a5e4d94774d2cbfeb96664ed7295f20b8618fe8 (patch) | |
tree | 6b375c8f969675d6db8729f9c90d005a1ae089f7 /cpukit/score/src | |
parent | score: Use <sys/bitset.h> for Processor_mask (diff) | |
download | rtems-7a5e4d94774d2cbfeb96664ed7295f20b8618fe8.tar.bz2 |
score: Add processor mask to/from cpu_set_t
Update #3059.
Diffstat (limited to 'cpukit/score/src')
-rw-r--r-- | cpukit/score/src/processormaskcopy.c | 75 |
1 files changed, 75 insertions, 0 deletions
diff --git a/cpukit/score/src/processormaskcopy.c b/cpukit/score/src/processormaskcopy.c new file mode 100644 index 0000000000..bf8082d3c4 --- /dev/null +++ b/cpukit/score/src/processormaskcopy.c @@ -0,0 +1,75 @@ +/** + * @file + * + * @brief Processor Mask Implementation + * + * @ingroup ScoreProcessorMask + */ + +/* + * Copyright (c) 2017 embedded brains GmbH. All rights reserved. + * + * embedded brains GmbH + * Dornierstr. 4 + * 82178 Puchheim + * Germany + * <rtems@embedded-brains.de> + * + * The license and distribution terms for this file may be + * found in the file LICENSE in this distribution or at + * http://www.rtems.org/license/LICENSE. + */ + +#if HAVE_CONFIG_H +#include "config.h" +#endif + +#include <rtems/score/processormask.h> + +Processor_mask_Copy_status _Processor_mask_Copy( + long *dst, + size_t dst_size, + const long *src, + size_t src_size +) +{ + long inclusive = 0; + long exclusive = 0; + + if ( ( dst_size | src_size ) % sizeof( long ) != 0 ) { + return PROCESSOR_MASK_COPY_INVALID_SIZE; + } + + while ( dst_size > 0 && src_size > 0 ) { + long bits = *src; + + inclusive |= bits; + *dst = bits; + ++dst; + ++src; + dst_size -= sizeof( long ); + src_size -= sizeof( long ); + } + + while ( dst_size > 0 ) { + *dst = 0; + ++dst; + dst_size -= sizeof( long ); + } + + while ( src_size > 0 ) { + exclusive |= *src; + ++src; + src_size -= sizeof( long ); + } + + if ( exclusive != 0 ) { + if ( inclusive != 0 ) { + return PROCESSOR_MASK_COPY_PARTIAL_LOSS; + } else { + return PROCESSOR_MASK_COPY_COMPLETE_LOSS; + } + } + + return PROCESSOR_MASK_COPY_LOSSLESS; +} |