[Feature]add MT2731_MP2_MR2_SVN388 baseline version
Change-Id: Ief04314834b31e27effab435d3ca8ba33b499059
diff --git a/src/bsp/lk/include/kernel/mp.h b/src/bsp/lk/include/kernel/mp.h
new file mode 100644
index 0000000..a015ebd
--- /dev/null
+++ b/src/bsp/lk/include/kernel/mp.h
@@ -0,0 +1,129 @@
+/*
+ * Copyright (c) 2014 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.
+ */
+#pragma once
+
+#include <compiler.h>
+#include <limits.h>
+#include <stdbool.h>
+#include <stdint.h>
+#include <kernel/thread.h>
+
+__BEGIN_CDECLS;
+
+typedef uint32_t mp_cpu_mask_t;
+
+#define MP_CPU_ALL_BUT_LOCAL (UINT32_MAX)
+
+/* by default, mp_mbx_reschedule does not signal to cpus that are running realtime
+ * threads. Override this behavior.
+ */
+#define MP_RESCHEDULE_FLAG_REALTIME (0x1)
+
+typedef enum {
+ MP_IPI_GENERIC,
+ MP_IPI_RESCHEDULE,
+} mp_ipi_t;
+
+#ifdef WITH_SMP
+void mp_init(void);
+
+void mp_reschedule(mp_cpu_mask_t target, uint flags);
+void mp_set_curr_cpu_active(bool active);
+
+/* called from arch code during reschedule irq */
+enum handler_return mp_mbx_reschedule_irq(void);
+
+/* global mp state to track what the cpus are up to */
+struct mp_state {
+ volatile mp_cpu_mask_t active_cpus;
+
+ /* only safely accessible with thread lock held */
+ mp_cpu_mask_t idle_cpus;
+ mp_cpu_mask_t realtime_cpus;
+};
+
+extern struct mp_state mp;
+
+static inline int mp_is_cpu_active(uint cpu)
+{
+ return mp.active_cpus & (1 << cpu);
+}
+
+static inline int mp_is_cpu_idle(uint cpu)
+{
+ return mp.idle_cpus & (1 << cpu);
+}
+
+/* must be called with the thread lock held */
+static inline void mp_set_cpu_idle(uint cpu)
+{
+ mp.idle_cpus |= 1UL << cpu;
+}
+
+static inline void mp_set_cpu_busy(uint cpu)
+{
+ mp.idle_cpus &= ~(1UL << cpu);
+}
+
+static inline mp_cpu_mask_t mp_get_idle_mask(void)
+{
+ return mp.idle_cpus;
+}
+
+static inline void mp_set_cpu_realtime(uint cpu)
+{
+ mp.realtime_cpus |= 1UL << cpu;
+}
+
+static inline void mp_set_cpu_non_realtime(uint cpu)
+{
+ mp.realtime_cpus &= ~(1UL << cpu);
+}
+
+static inline mp_cpu_mask_t mp_get_realtime_mask(void)
+{
+ return mp.realtime_cpus;
+}
+#else
+static inline void mp_init(void) {}
+static inline void mp_reschedule(mp_cpu_mask_t target, uint flags) {}
+static inline void mp_set_curr_cpu_active(bool active) {}
+
+static inline enum handler_return mp_mbx_reschedule_irq(void) { return 0; }
+
+// only one cpu exists in UP and if you're calling these functions, it's active...
+static inline int mp_is_cpu_active(uint cpu) { return 1; }
+static inline int mp_is_cpu_idle(uint cpu) { return 0; }
+
+static inline void mp_set_cpu_idle(uint cpu) {}
+static inline void mp_set_cpu_busy(uint cpu) {}
+
+static inline mp_cpu_mask_t mp_get_idle_mask(void) { return 0; }
+
+static inline void mp_set_cpu_realtime(uint cpu) {}
+static inline void mp_set_cpu_non_realtime(uint cpu) {}
+
+static inline mp_cpu_mask_t mp_get_realtime_mask(void) { return 0; }
+#endif
+
+__END_CDECLS;