aboutsummaryrefslogtreecommitdiffstats
path: root/os
diff options
context:
space:
mode:
Diffstat (limited to 'os')
-rw-r--r--os/various/bitmap.c158
-rw-r--r--os/various/bitmap.h77
2 files changed, 235 insertions, 0 deletions
diff --git a/os/various/bitmap.c b/os/various/bitmap.c
new file mode 100644
index 0000000..a17dfcb
--- /dev/null
+++ b/os/various/bitmap.c
@@ -0,0 +1,158 @@
+/*
+ ChibiOS/HAL - Copyright (C) 2015 Uladzimir Pylinsky aka barthess
+
+ 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.
+*/
+
+/**
+ * @file bitmap.c
+ * @brief Bit map code.
+ *
+ * @addtogroup bitmap
+ * @{
+ */
+
+#include "string.h" /* for memset() */
+
+#include "hal.h"
+#include "bitmap.h"
+
+/*===========================================================================*/
+/* Module local definitions. */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Module exported variables. */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Module local types. */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Module local variables. */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Module local functions. */
+/*===========================================================================*/
+
+/**
+ * @brief Get word number.
+ *
+ * @param[in] bit number of the bit
+ *
+ * @return Index of the word containing specified bit.
+ */
+static inline size_t word(size_t bit) {
+ return bit / (sizeof(bitmap_word_t) * 8);
+}
+
+/**
+ * @brief Get bit position in word.
+ *
+ * @param[in] bit number of the bit
+ *
+ * @return Position of the specified bit related to word start.
+ */
+static inline size_t pos_in_word(size_t bit) {
+ return bit % (sizeof(bitmap_word_t) * 8);
+}
+
+/*===========================================================================*/
+/* Module exported functions. */
+/*===========================================================================*/
+/**
+ * @brief Initializes an @p bitmap_t structure.
+ *
+ * @param[out] map the @p bitmap_t structure to be initialized
+ * @param[in] val the value to be written in all bitmap
+ */
+void bitmapObjectInit(bitmap_t *map, bitmap_word_t val) {
+ uint8_t pattern;
+
+ osalDbgCheck(val == 1 || val == 0);
+
+ if (val == 1)
+ pattern = 0xFF;
+ else
+ pattern = 0;
+
+ memset(map->array, pattern, map->len*sizeof(bitmap_word_t));
+}
+
+/**
+ * @brief Set single bit in an @p bitmap_t structure.
+ *
+ * @param[out] map the @p bitmap_t structure
+ * @param[in] bit number of the bit to be set
+ */
+void bitmapSet(bitmap_t *map, size_t bit) {
+ size_t w = word(bit);
+
+ osalDbgCheck(w < map->len);
+ map->array[w] |= (bitmap_word_t)1 << pos_in_word(bit);
+}
+
+/**
+ * @brief Clear single bit in an @p bitmap_t structure.
+ *
+ * @param[out] map the @p bitmap_t structure
+ * @param[in] bit number of the bit to be cleared
+ */
+void bitmapClear(bitmap_t *map, size_t bit) {
+ size_t w = word(bit);
+
+ osalDbgCheck(w < map->len);
+ map->array[w] &= ~((bitmap_word_t)1 << pos_in_word(bit));
+}
+
+/**
+ * @brief Invert single bit in an @p bitmap_t structure.
+ *
+ * @param[out] map the @p bitmap_t structure
+ * @param[in] bit number of the bit to be inverted
+ */
+void bitmapInvert(bitmap_t *map, size_t bit) {
+ size_t w = word(bit);
+
+ osalDbgCheck(w < map->len);
+ map->array[w] ^= (bitmap_word_t)1 << pos_in_word(bit);
+}
+
+/**
+ * @brief Get bit value from an @p bitmap_t structure.
+ *
+ * @param[in] map the @p bitmap_t structure
+ * @param[in] bit number of the requested bit
+ *
+ * @return Requested bit value.
+ */
+bitmap_word_t bitmapGet(const bitmap_t *map, size_t bit) {
+ size_t w = word(bit);
+
+ osalDbgCheck(w < map->len);
+ return (map->array[w] >> pos_in_word(bit)) & 1;
+}
+
+/**
+ * @brief Get total amount of bits in an @p bitmap_t structure.
+ *
+ * @param[in] map the @p bitmap_t structure
+ *
+ * @return Bit number.
+ */
+size_t bitmapGetBitsCount(const bitmap_t *map) {
+ return map->len * sizeof(bitmap_word_t) * 8;
+}
+/** @} */
diff --git a/os/various/bitmap.h b/os/various/bitmap.h
new file mode 100644
index 0000000..d7831aa
--- /dev/null
+++ b/os/various/bitmap.h
@@ -0,0 +1,77 @@
+/*
+ ChibiOS/HAL - Copyright (C) 2015 Uladzimir Pylinsky aka barthess
+
+ 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.
+*/
+
+/**
+ * @file bitmap.h
+ * @brief Bit map structures and macros.
+ *
+ * @addtogroup bitmap
+ * @{
+ */
+
+#ifndef _BITMAP_H_
+#define _BITMAP_H_
+
+/*===========================================================================*/
+/* Module constants. */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Module pre-compile time settings. */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Derived constants and error checks. */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Module data structures and types. */
+/*===========================================================================*/
+
+typedef unsigned int bitmap_word_t;
+
+/**
+ * @brief Type of a event timer structure.
+ */
+typedef struct {
+ bitmap_word_t *array;
+ size_t len; /* Array length in _words_ NOT bytes */
+} bitmap_t;
+
+/*===========================================================================*/
+/* Module macros. */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* External declarations. */
+/*===========================================================================*/
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+ void bitmapObjectInit(bitmap_t *map, bitmap_word_t val);
+ void bitmapSet(bitmap_t *map, size_t bit);
+ void bitmapClear(bitmap_t *map, size_t bit);
+ void bitmapInvert(bitmap_t *map, size_t bit);
+ bitmap_word_t bitmapGet(const bitmap_t *map, size_t bit);
+ size_t bitmapGetBitsCount(const bitmap_t *map);
+#ifdef __cplusplus
+}
+#endif
+
+#endif /* _BITMAP_H_ */
+
+/** @} */