Diff: mbed-os/targets/TARGET_NUVOTON/nu_bitutil.h

Revision:

0:9fca2b23d0ba

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/mbed-os/targets/TARGET_NUVOTON/nu_bitutil.h	Sat Feb 23 12:13:36 2019 +0000
@@ -0,0 +1,131 @@
+/* mbed Microcontroller Library
+ * Copyright (c) 2015-2016 Nuvoton
+ *
+ * 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.
+ */
+
+#ifndef NU_BIT_UTIL_H
+#define NU_BIT_UTIL_H
+
+#if defined(__ICCARM__) && defined(TARGET_M0)
+#include <arm_math.h>
+#endif
+#include "cmsis.h"
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+__STATIC_INLINE int nu_clz(uint32_t x)
+{
+    return __CLZ(x);
+}
+
+__STATIC_INLINE int nu_clo(uint32_t x)
+{
+    return nu_clz(~x);
+}
+
+__STATIC_INLINE int nu_ctz(uint32_t x)
+{
+    int c = __CLZ(x & -x);
+    return x ? 31 - c : c;
+}
+
+__STATIC_INLINE int nu_cto(uint32_t x)
+{
+    return nu_ctz(~x);
+}
+
+
+__STATIC_INLINE uint16_t nu_get16_le(const uint8_t *pos)
+{
+	uint16_t val;
+	
+	val = *pos ++;
+	val += (*pos << 8);
+	
+	return val;
+}
+
+__STATIC_INLINE void nu_set16_le(uint8_t *pos, uint16_t val)
+{
+	*pos ++ = val & 0xFF;
+	*pos = val >> 8;
+}
+
+__STATIC_INLINE uint32_t nu_get32_le(const uint8_t *pos)
+{
+	uint32_t val;
+	
+	val = *pos ++;
+	val += (*pos ++ << 8);
+	val += (*pos ++ << 16);
+	val += (*pos ++ << 24);
+	
+	return val;
+}
+
+__STATIC_INLINE void nu_set32_le(uint8_t *pos, uint32_t val)
+{
+	*pos ++ = val & 0xFF;
+	*pos ++ = (val >> 8) & 0xFF;
+	*pos ++ = (val >> 16) & 0xFF;
+	*pos = (val >> 24) & 0xFF;
+}
+
+__STATIC_INLINE uint16_t nu_get16_be(const uint8_t *pos)
+{
+	uint16_t val;
+	
+	val = *pos ++;
+	val <<= 8;
+	val += *pos;
+	
+	return val;
+}
+
+__STATIC_INLINE void nu_set16_be(uint8_t *pos, uint16_t val)
+{
+	*pos ++ = val >> 8;
+	*pos = (val & 0xFF);
+}
+
+__STATIC_INLINE uint32_t nu_get32_be(const uint8_t *pos)
+{
+	uint32_t val;
+	
+	val = *pos ++;
+	val <<= 8;
+	val += *pos ++;
+	val <<= 8;
+	val += *pos ++;
+	val <<= 8;
+	val += *pos;
+	
+	return val;
+}
+
+__STATIC_INLINE void nu_set32_be(uint8_t *pos, uint32_t val)
+{
+	*pos ++ = val >> 24;
+	*pos ++ = val >> 16;
+	*pos ++ = val >> 8;
+	*pos ++ = (val & 0xFF);
+}
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif