BA / SerialCom

Fork of OmniWheels by Gustav Atmel

Committer:
gustavatmel
Date:
Tue May 01 15:55:34 2018 +0000
Revision:
2:798925c9e4a8
Parent:
1:9c5af431a1f1
bluetooth

Who changed what in which revision?

UserRevisionLine numberNew contents of line
gustavatmel 1:9c5af431a1f1 1 /* mbed Microcontroller Library
gustavatmel 1:9c5af431a1f1 2 * Copyright (c) 2015-2016 Nuvoton
gustavatmel 1:9c5af431a1f1 3 *
gustavatmel 1:9c5af431a1f1 4 * Licensed under the Apache License, Version 2.0 (the "License");
gustavatmel 1:9c5af431a1f1 5 * you may not use this file except in compliance with the License.
gustavatmel 1:9c5af431a1f1 6 * You may obtain a copy of the License at
gustavatmel 1:9c5af431a1f1 7 *
gustavatmel 1:9c5af431a1f1 8 * http://www.apache.org/licenses/LICENSE-2.0
gustavatmel 1:9c5af431a1f1 9 *
gustavatmel 1:9c5af431a1f1 10 * Unless required by applicable law or agreed to in writing, software
gustavatmel 1:9c5af431a1f1 11 * distributed under the License is distributed on an "AS IS" BASIS,
gustavatmel 1:9c5af431a1f1 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
gustavatmel 1:9c5af431a1f1 13 * See the License for the specific language governing permissions and
gustavatmel 1:9c5af431a1f1 14 * limitations under the License.
gustavatmel 1:9c5af431a1f1 15 */
gustavatmel 1:9c5af431a1f1 16
gustavatmel 1:9c5af431a1f1 17 #ifndef NU_BIT_UTIL_H
gustavatmel 1:9c5af431a1f1 18 #define NU_BIT_UTIL_H
gustavatmel 1:9c5af431a1f1 19
gustavatmel 1:9c5af431a1f1 20 #if defined(__ICCARM__) && defined(TARGET_M0)
gustavatmel 1:9c5af431a1f1 21 #include <arm_math.h>
gustavatmel 1:9c5af431a1f1 22 #endif
gustavatmel 1:9c5af431a1f1 23 #include "cmsis.h"
gustavatmel 1:9c5af431a1f1 24
gustavatmel 1:9c5af431a1f1 25 #ifdef __cplusplus
gustavatmel 1:9c5af431a1f1 26 extern "C" {
gustavatmel 1:9c5af431a1f1 27 #endif
gustavatmel 1:9c5af431a1f1 28
gustavatmel 1:9c5af431a1f1 29 __STATIC_INLINE int nu_clz(uint32_t x)
gustavatmel 1:9c5af431a1f1 30 {
gustavatmel 1:9c5af431a1f1 31 return __CLZ(x);
gustavatmel 1:9c5af431a1f1 32 }
gustavatmel 1:9c5af431a1f1 33
gustavatmel 1:9c5af431a1f1 34 __STATIC_INLINE int nu_clo(uint32_t x)
gustavatmel 1:9c5af431a1f1 35 {
gustavatmel 1:9c5af431a1f1 36 return nu_clz(~x);
gustavatmel 1:9c5af431a1f1 37 }
gustavatmel 1:9c5af431a1f1 38
gustavatmel 1:9c5af431a1f1 39 __STATIC_INLINE int nu_ctz(uint32_t x)
gustavatmel 1:9c5af431a1f1 40 {
gustavatmel 1:9c5af431a1f1 41 int c = __CLZ(x & -x);
gustavatmel 1:9c5af431a1f1 42 return x ? 31 - c : c;
gustavatmel 1:9c5af431a1f1 43 }
gustavatmel 1:9c5af431a1f1 44
gustavatmel 1:9c5af431a1f1 45 __STATIC_INLINE int nu_cto(uint32_t x)
gustavatmel 1:9c5af431a1f1 46 {
gustavatmel 1:9c5af431a1f1 47 return nu_ctz(~x);
gustavatmel 1:9c5af431a1f1 48 }
gustavatmel 1:9c5af431a1f1 49
gustavatmel 1:9c5af431a1f1 50
gustavatmel 1:9c5af431a1f1 51 __STATIC_INLINE uint16_t nu_get16_le(const uint8_t *pos)
gustavatmel 1:9c5af431a1f1 52 {
gustavatmel 1:9c5af431a1f1 53 uint16_t val;
gustavatmel 1:9c5af431a1f1 54
gustavatmel 1:9c5af431a1f1 55 val = *pos ++;
gustavatmel 1:9c5af431a1f1 56 val += (*pos << 8);
gustavatmel 1:9c5af431a1f1 57
gustavatmel 1:9c5af431a1f1 58 return val;
gustavatmel 1:9c5af431a1f1 59 }
gustavatmel 1:9c5af431a1f1 60
gustavatmel 1:9c5af431a1f1 61 __STATIC_INLINE void nu_set16_le(uint8_t *pos, uint16_t val)
gustavatmel 1:9c5af431a1f1 62 {
gustavatmel 1:9c5af431a1f1 63 *pos ++ = val & 0xFF;
gustavatmel 1:9c5af431a1f1 64 *pos = val >> 8;
gustavatmel 1:9c5af431a1f1 65 }
gustavatmel 1:9c5af431a1f1 66
gustavatmel 1:9c5af431a1f1 67 __STATIC_INLINE uint32_t nu_get32_le(const uint8_t *pos)
gustavatmel 1:9c5af431a1f1 68 {
gustavatmel 1:9c5af431a1f1 69 uint32_t val;
gustavatmel 1:9c5af431a1f1 70
gustavatmel 1:9c5af431a1f1 71 val = *pos ++;
gustavatmel 1:9c5af431a1f1 72 val += (*pos ++ << 8);
gustavatmel 1:9c5af431a1f1 73 val += (*pos ++ << 16);
gustavatmel 1:9c5af431a1f1 74 val += (*pos ++ << 24);
gustavatmel 1:9c5af431a1f1 75
gustavatmel 1:9c5af431a1f1 76 return val;
gustavatmel 1:9c5af431a1f1 77 }
gustavatmel 1:9c5af431a1f1 78
gustavatmel 1:9c5af431a1f1 79 __STATIC_INLINE void nu_set32_le(uint8_t *pos, uint32_t val)
gustavatmel 1:9c5af431a1f1 80 {
gustavatmel 1:9c5af431a1f1 81 *pos ++ = val & 0xFF;
gustavatmel 1:9c5af431a1f1 82 *pos ++ = (val >> 8) & 0xFF;
gustavatmel 1:9c5af431a1f1 83 *pos ++ = (val >> 16) & 0xFF;
gustavatmel 1:9c5af431a1f1 84 *pos = (val >> 24) & 0xFF;
gustavatmel 1:9c5af431a1f1 85 }
gustavatmel 1:9c5af431a1f1 86
gustavatmel 1:9c5af431a1f1 87 __STATIC_INLINE uint16_t nu_get16_be(const uint8_t *pos)
gustavatmel 1:9c5af431a1f1 88 {
gustavatmel 1:9c5af431a1f1 89 uint16_t val;
gustavatmel 1:9c5af431a1f1 90
gustavatmel 1:9c5af431a1f1 91 val = *pos ++;
gustavatmel 1:9c5af431a1f1 92 val <<= 8;
gustavatmel 1:9c5af431a1f1 93 val += *pos;
gustavatmel 1:9c5af431a1f1 94
gustavatmel 1:9c5af431a1f1 95 return val;
gustavatmel 1:9c5af431a1f1 96 }
gustavatmel 1:9c5af431a1f1 97
gustavatmel 1:9c5af431a1f1 98 __STATIC_INLINE void nu_set16_be(uint8_t *pos, uint16_t val)
gustavatmel 1:9c5af431a1f1 99 {
gustavatmel 1:9c5af431a1f1 100 *pos ++ = val >> 8;
gustavatmel 1:9c5af431a1f1 101 *pos = (val & 0xFF);
gustavatmel 1:9c5af431a1f1 102 }
gustavatmel 1:9c5af431a1f1 103
gustavatmel 1:9c5af431a1f1 104 __STATIC_INLINE uint32_t nu_get32_be(const uint8_t *pos)
gustavatmel 1:9c5af431a1f1 105 {
gustavatmel 1:9c5af431a1f1 106 uint32_t val;
gustavatmel 1:9c5af431a1f1 107
gustavatmel 1:9c5af431a1f1 108 val = *pos ++;
gustavatmel 1:9c5af431a1f1 109 val <<= 8;
gustavatmel 1:9c5af431a1f1 110 val += *pos ++;
gustavatmel 1:9c5af431a1f1 111 val <<= 8;
gustavatmel 1:9c5af431a1f1 112 val += *pos ++;
gustavatmel 1:9c5af431a1f1 113 val <<= 8;
gustavatmel 1:9c5af431a1f1 114 val += *pos;
gustavatmel 1:9c5af431a1f1 115
gustavatmel 1:9c5af431a1f1 116 return val;
gustavatmel 1:9c5af431a1f1 117 }
gustavatmel 1:9c5af431a1f1 118
gustavatmel 1:9c5af431a1f1 119 __STATIC_INLINE void nu_set32_be(uint8_t *pos, uint32_t val)
gustavatmel 1:9c5af431a1f1 120 {
gustavatmel 1:9c5af431a1f1 121 *pos ++ = val >> 24;
gustavatmel 1:9c5af431a1f1 122 *pos ++ = val >> 16;
gustavatmel 1:9c5af431a1f1 123 *pos ++ = val >> 8;
gustavatmel 1:9c5af431a1f1 124 *pos ++ = (val & 0xFF);
gustavatmel 1:9c5af431a1f1 125 }
gustavatmel 1:9c5af431a1f1 126
gustavatmel 1:9c5af431a1f1 127 #ifdef __cplusplus
gustavatmel 1:9c5af431a1f1 128 }
gustavatmel 1:9c5af431a1f1 129 #endif
gustavatmel 1:9c5af431a1f1 130
gustavatmel 1:9c5af431a1f1 131 #endif