[Feature]add MT2731_MP2_MR2_SVN388 baseline version
Change-Id: Ief04314834b31e27effab435d3ca8ba33b499059
diff --git a/src/bsp/lk/lib/bytes/bytes.c b/src/bsp/lk/lib/bytes/bytes.c
new file mode 100644
index 0000000..1d1ad6f
--- /dev/null
+++ b/src/bsp/lk/lib/bytes/bytes.c
@@ -0,0 +1,178 @@
+/*
+ * Copyright (c) 2013 Travis Geiselbrecht
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining
+ * a copy of this software and associated documentation files
+ * (the "Software"), to deal in the Software without restriction,
+ * including without limitation the rights to use, copy, modify, merge,
+ * publish, distribute, sublicense, and/or sell copies of the Software,
+ * and to permit persons to whom the Software is furnished to do so,
+ * subject to the following conditions:
+ *
+ * The above copyright notice and this permission notice shall be
+ * included in all copies or substantial portions of the Software.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
+ * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
+ * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
+ * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
+ * CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
+ * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
+ * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
+ */
+
+#include <stdint.h>
+#include <lib/bytes.h>
+
+// Big endian interfaces
+uint16_t bytes_read_u16_be(const uint8_t *buf)
+{
+ uint16_t val;
+
+ val = (buf[0] << 8) | buf[1];
+
+ return(val);
+}
+
+uint32_t bytes_read_u24_be(const uint8_t *buf)
+{
+ uint32_t val;
+
+ val = (buf[0] << 16) | (buf[1] << 8) | buf[2];
+
+ return(val);
+}
+
+uint32_t bytes_read_u32_be(const uint8_t *buf)
+{
+ uint32_t val;
+
+ val = (buf[0] << 24) | (buf[1] << 16) | (buf[2] << 8) | buf[3];
+
+ return(val);
+}
+
+uint8_t* bytes_write_u16_be(uint8_t *buf, uint16_t val)
+{
+ *buf++ = (val >> 8) & 0xFF;
+ *buf++ = (val ) & 0xFF;
+
+ return(buf);
+}
+
+uint8_t* bytes_write_u24_be(uint8_t *buf, uint32_t val)
+{
+ *buf++ = (val >> 16) & 0xFF;
+ *buf++ = (val >> 8) & 0xFF;
+ *buf++ = (val ) & 0xFF;
+
+ return(buf);
+}
+
+uint8_t* bytes_write_u32_be(uint8_t *buf, uint32_t val)
+{
+ *buf++ = (val >> 24) & 0xFF;
+ *buf++ = (val >> 16) & 0xFF;
+ *buf++ = (val >> 8) & 0xFF;
+ *buf++ = (val ) & 0xFF;
+
+ return(buf);
+}
+
+
+// Little endian interfaces
+uint16_t bytes_read_u16_le(const uint8_t *buf)
+{
+ uint16_t val;
+
+ val = (buf[1] << 8) | buf[0];
+
+ return(val);
+}
+
+uint32_t bytes_read_u24_le(const uint8_t *buf)
+{
+ uint32_t val;
+
+ val = (buf[2] << 16) | (buf[1] << 8) | buf[0];
+
+ return(val);
+}
+
+uint32_t bytes_read_u32_le(const uint8_t *buf)
+{
+ uint32_t val;
+
+ val = (buf[3] << 24) | (buf[2] << 16) | (buf[1] << 8) | buf[0];
+
+ return(val);
+}
+
+uint8_t* bytes_write_u16_le(uint8_t *buf, uint16_t val)
+{
+ *buf++ = (val ) & 0xFF;
+ *buf++ = (val >> 8) & 0xFF;
+
+ return(buf);
+}
+
+uint8_t* bytes_write_u24_le(uint8_t *buf, uint32_t val)
+{
+ *buf++ = (val ) & 0xFF;
+ *buf++ = (val >> 8) & 0xFF;
+ *buf++ = (val >> 16) & 0xFF;
+
+ return(buf);
+}
+
+uint8_t* bytes_write_u32_le(uint8_t *buf, uint32_t val)
+{
+ *buf++ = (val ) & 0xFF;
+ *buf++ = (val >> 8) & 0xFF;
+ *buf++ = (val >> 16) & 0xFF;
+ *buf++ = (val >> 24) & 0xFF;
+
+ return(buf);
+}
+
+uint8_t bytes_swap_bits_u8(uint8_t val)
+{
+ val = ((val >> 1) & 0x55) | ((val & 0x55) << 1);
+ val = ((val >> 2) & 0x33) | ((val & 0x33) << 2);
+ val = ((val >> 4) & 0x0f) | ((val & 0x0f) << 4);
+
+ return(val);
+}
+
+uint16_t bytes_swap_bits_u16(uint16_t val)
+{
+ val = ((val >> 1) & 0x5555) | ((val & 0x5555) << 1);
+ val = ((val >> 2) & 0x3333) | ((val & 0x3333) << 2);
+ val = ((val >> 4) & 0x0f0f) | ((val & 0x0f0f) << 4);
+ val = ((val >> 8) & 0x00ff) | ((val & 0x00ff) << 8);
+
+ return(val);
+}
+
+uint32_t bytes_swap_bits_u24(uint32_t val)
+{
+ val &= 0x00FFFFFF;
+ val = ((val >> 1) & 0x555555) | ((val & 0x555555) << 1);
+ val = ((val >> 2) & 0x333333) | ((val & 0x333333) << 2);
+ val = ((val >> 4) & 0x0f0f0f) | ((val & 0x0f0f0f) << 4);
+ val = ((val >> 16) & 0x0000ff) | ((val & 0x0000ff) << 16) | (val & 0x00FF00);
+
+ return(val);
+}
+
+uint32_t bytes_swap_bits_u32(uint32_t val)
+{
+ val = ((val >> 1) & 0x55555555) | ((val & 0x55555555) << 1);
+ val = ((val >> 2) & 0x33333333) | ((val & 0x33333333) << 2);
+ val = ((val >> 4) & 0x0f0f0f0f) | ((val & 0x0f0f0f0f) << 4);
+ val = ((val >> 8) & 0x00ff00ff) | ((val & 0x00ff00ff) << 8);
+ val = ((val >> 16) & 0x0000ffff) | ((val & 0x0000ffff) << 16);
+
+ return(val);
+}
+
diff --git a/src/bsp/lk/lib/bytes/rules.mk b/src/bsp/lk/lib/bytes/rules.mk
new file mode 100644
index 0000000..22d6826
--- /dev/null
+++ b/src/bsp/lk/lib/bytes/rules.mk
@@ -0,0 +1,8 @@
+LOCAL_DIR := $(GET_LOCAL_DIR)
+
+MODULE := $(LOCAL_DIR)
+
+MODULE_SRCS += \
+ $(LOCAL_DIR)/bytes.c
+
+include make/module.mk