forked from bukinr/openocd-nrf9160
-
Notifications
You must be signed in to change notification settings - Fork 0
Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
helper: add bitmap helper primitives
Mainly copied/inspired from Linux kernel code in - include/linux/types.h - include/linux/bitmap.h - include/linux/bitops.h Change-Id: I317b542993ab81530c86553f339b79505d0fef0f Signed-off-by: Antonio Borneo <[email protected]> Reviewed-on: http:https://openocd.zylin.com/4894 Tested-by: jenkins Reviewed-by: Tomas Vanek <[email protected]>
- Loading branch information
Showing
2 changed files
with
85 additions
and
0 deletions.
There are no files selected for viewing
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -0,0 +1,84 @@ | ||
/* | ||
* Copyright (C) 2018, STMicroelectronics - All Rights Reserved | ||
* Author(s): Antonio Borneo <[email protected]> for STMicroelectronics | ||
* | ||
* This program is free software; you can redistribute it and/or modify | ||
* it under the terms of the GNU General Public License as published by | ||
* the Free Software Foundation; either version 2 of the License, or | ||
* (at your option) any later version. | ||
* | ||
* This program is distributed in the hope that it will be useful | ||
* but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
* GNU General Public License for more details. | ||
* | ||
* You should have received a copy of the GNU General Public License | ||
* along with this program. If not, see <http:https://www.gnu.org/licenses/>. | ||
*/ | ||
|
||
/* | ||
* The content of this file is mainly copied/inspired from Linux kernel | ||
* code in include/linux/types.h include/linux/bitmap.h include/linux/bitops.h | ||
*/ | ||
|
||
#ifndef OPENOCD_HELPER_BITS_H | ||
#define OPENOCD_HELPER_BITS_H | ||
|
||
#include <helper/types.h> | ||
|
||
#define BIT(nr) (1UL << (nr)) | ||
#define BITS_PER_BYTE 8 | ||
#define BITS_PER_LONG (BITS_PER_BYTE * sizeof(long)) | ||
#define BITS_TO_LONGS(nr) DIV_ROUND_UP(nr, BITS_PER_BYTE * sizeof(long)) | ||
#define BIT_MASK(nr) (1UL << ((nr) % BITS_PER_LONG)) | ||
#define BIT_WORD(nr) ((nr) / BITS_PER_LONG) | ||
#define DECLARE_BITMAP(name, bits) unsigned long name[BITS_TO_LONGS(bits)] | ||
|
||
/** | ||
* bitmap_zero - Clears all the bits in memory | ||
* @dst: the address of the bitmap | ||
* @nbits: the number of bits to clear | ||
*/ | ||
static inline void bitmap_zero(unsigned long *dst, unsigned int nbits) | ||
{ | ||
unsigned int len = BITS_TO_LONGS(nbits) * sizeof(unsigned long); | ||
memset(dst, 0, len); | ||
} | ||
|
||
/** | ||
* clear_bit - Clear a bit in memory | ||
* @nr: the bit to set | ||
* @addr: the address to start counting from | ||
*/ | ||
static inline void clear_bit(unsigned int nr, volatile unsigned long *addr) | ||
{ | ||
unsigned long mask = BIT_MASK(nr); | ||
unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr); | ||
|
||
*p &= ~mask; | ||
} | ||
|
||
/** | ||
* set_bit - Set a bit in memory | ||
* @nr: the bit to set | ||
* @addr: the address to start counting from | ||
*/ | ||
static inline void set_bit(unsigned int nr, volatile unsigned long *addr) | ||
{ | ||
unsigned long mask = BIT_MASK(nr); | ||
unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr); | ||
|
||
*p |= mask; | ||
} | ||
|
||
/** | ||
* test_bit - Determine whether a bit is set | ||
* @nr: bit number to test | ||
* @addr: Address to start counting from | ||
*/ | ||
static inline int test_bit(unsigned int nr, const volatile unsigned long *addr) | ||
{ | ||
return 1UL & (addr[BIT_WORD(nr)] >> (nr % BITS_PER_LONG)); | ||
} | ||
|
||
#endif /* OPENOCD_HELPER_BITS_H */ |