From 140783ef66eef379feedcfef5403c5729d38936a Mon Sep 17 00:00:00 2001
From: Amaury Pouly <amaury.pouly@gmail.com>
Date: Sat, 13 Jul 2013 17:35:53 +0200
Subject: hwstub: split target specific code from the common part

Completely rewrite the Mafile, properly put the usb driver in its
own file and the target specific files in a subdirectory.

Change-Id: Iaeee0128e021d5dad76b4d6035a63e33e2d946c1
---
 utils/hwstub/stub/system.h | 118 +++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 118 insertions(+)
 create mode 100644 utils/hwstub/stub/system.h

(limited to 'utils/hwstub/stub/system.h')

diff --git a/utils/hwstub/stub/system.h b/utils/hwstub/stub/system.h
new file mode 100644
index 0000000000..e5aea12051
--- /dev/null
+++ b/utils/hwstub/stub/system.h
@@ -0,0 +1,118 @@
+/***************************************************************************
+ *             __________               __   ___.
+ *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
+ *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
+ *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
+ *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
+ *                     \/            \/     \/    \/            \/
+ * $Id$
+ *
+ * Copyright (C) 2012 by Amaury Pouly
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License
+ * as published by the Free Software Foundation; either version 2
+ * of the License, or (at your option) any later version.
+ *
+ * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
+ * KIND, either express or implied.
+ *
+ ****************************************************************************/
+#ifndef __HWSTUB_SYSTEM__
+#define __HWSTUB_SYSTEM__
+
+#define IRQ_ENABLED      0x00
+#define IRQ_DISABLED     0x80
+#define IRQ_STATUS       0x80
+#define FIQ_ENABLED      0x00
+#define FIQ_DISABLED     0x40
+#define FIQ_STATUS       0x40
+#define IRQ_FIQ_ENABLED  0x00
+#define IRQ_FIQ_DISABLED 0xc0
+#define IRQ_FIQ_STATUS   0xc0
+#define HIGHEST_IRQ_LEVEL IRQ_DISABLED
+
+#define set_irq_level(status) \
+    set_interrupt_status((status), IRQ_STATUS)
+#define set_fiq_status(status) \
+    set_interrupt_status((status), FIQ_STATUS)
+
+#define disable_irq_save() \
+    disable_interrupt_save(IRQ_STATUS)
+#define disable_fiq_save() \
+    disable_interrupt_save(FIQ_STATUS)
+
+#define restore_irq(cpsr) \
+    restore_interrupt(cpsr)
+#define restore_fiq(cpsr) \
+    restore_interrupt(cpsr)
+
+#define disable_irq() \
+    disable_interrupt(IRQ_STATUS)
+#define enable_irq() \
+    enable_interrupt(IRQ_STATUS)
+#define disable_fiq() \
+    disable_interrupt(FIQ_STATUS)
+#define enable_fiq() \
+    enable_interrupt(FIQ_STATUS)
+
+static inline int set_interrupt_status(int status, int mask)
+{
+    unsigned long cpsr;
+    int oldstatus;
+    /* Read the old levels and set the new ones */
+    asm volatile (
+        "mrs    %1, cpsr        \n"
+        "bic    %0, %1, %[mask] \n"
+        "orr    %0, %0, %2      \n"
+        "msr    cpsr_c, %0      \n"
+        : "=&r,r"(cpsr), "=&r,r"(oldstatus)
+        : "r,i"(status & mask), [mask]"i,i"(mask));
+
+    return oldstatus;
+}
+
+static inline void restore_interrupt(int cpsr)
+{
+    /* Set cpsr_c from value returned by disable_interrupt_save
+     * or set_interrupt_status */
+    asm volatile ("msr cpsr_c, %0" : : "r"(cpsr));
+}
+
+static inline void enable_interrupt(int mask)
+{
+    /* Clear I and/or F disable bit */
+    int tmp;
+    asm volatile (
+        "mrs     %0, cpsr   \n"
+        "bic     %0, %0, %1 \n"
+        "msr     cpsr_c, %0 \n"
+        : "=&r"(tmp) : "i"(mask));
+}
+
+static inline void disable_interrupt(int mask)
+{
+    /* Set I and/or F disable bit */
+    int tmp;
+    asm volatile (
+        "mrs     %0, cpsr   \n"
+        "orr     %0, %0, %1 \n"
+        "msr     cpsr_c, %0 \n"
+        : "=&r"(tmp) : "i"(mask));
+}
+
+static inline int disable_interrupt_save(int mask)
+{
+    /* Set I and/or F disable bit and return old cpsr value */
+    int cpsr, tmp;
+    asm volatile (
+        "mrs     %1, cpsr   \n"
+        "orr     %0, %1, %2 \n"
+        "msr     cpsr_c, %0 \n"
+        : "=&r"(tmp), "=&r"(cpsr)
+        : "i"(mask));
+    return cpsr;
+}
+
+#endif /* __HWSTUB_SYSTEM__ */
+ 
-- 
cgit v1.2.3