1 files changed, 86 insertions, 0 deletions
diff --git a/examples/baremetal/cy7c68013a/nes-gamepads/core.c b/examples/baremetal/cy7c68013a/nes-gamepads/core.c
new file mode 100644
index 000000000..17a9661eb
--- /dev/null
+++ b/examples/baremetal/cy7c68013a/nes-gamepads/core.c
@@ -0,0 +1,86 @@
+/****************************************************************************
+**
+** Copyright (C) 2019 Denis Shienkov <denis.shienkov@gmail.com>
+** Contact: https://www.qt.io/licensing/
+**
+** This file is part of the examples of Qbs.
+**
+** $QT_BEGIN_LICENSE:BSD$
+** Commercial License Usage
+** Licensees holding valid commercial Qt licenses may use this file in
+** accordance with the commercial license agreement provided with the
+** Software or, alternatively, in accordance with the terms contained in
+** a written agreement between you and The Qt Company. For licensing terms
+** and conditions see https://www.qt.io/terms-conditions. For further
+** information use the contact form at https://www.qt.io/contact-us.
+**
+** BSD License Usage
+** Alternatively, you may use this file under the terms of the BSD license
+** as follows:
+**
+** "Redistribution and use in source and binary forms, with or without
+** modification, are permitted provided that the following conditions are
+** met:
+**   * Redistributions of source code must retain the above copyright
+**     notice, this list of conditions and the following disclaimer.
+**   * Redistributions in binary form must reproduce the above copyright
+**     notice, this list of conditions and the following disclaimer in
+**     the documentation and/or other materials provided with the
+**     distribution.
+**   * Neither the name of The Qt Company Ltd nor the names of its
+**     contributors may be used to endorse or promote products derived
+**     from this software without specific prior written permission.
+**
+**
+** THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
+** "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
+** LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
+** A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
+** OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
+** SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
+** LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
+** DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
+** THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
+** (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+** OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE."
+**
+** $QT_END_LICENSE$
+**
+****************************************************************************/
+
+#include "core.h"
+#include "regs.h"
+
+enum cpu_freq_clk {
+    CPU_CLK_12M = 0,
+    CPU_CLK_24M,
+    CPU_CLK_48M
+};
+
+#define cpu_freq_clk_get() \
+    ((CPUCS & bmCLKSPD) >> 3)
+
+#define cpu_freq_clk_set(freq_clk) \
+    CPUCS = (CPUCS & ~bmCLKSPD) | (freq_clk << 3)
+
+void core_init(void)
+{
+    // Set CPU clock to 48MHz.
+    cpu_freq_clk_set(CPU_CLK_48M);
+    sync_delay();
+    // Set stretch to 0.
+    CKCON = ((CKCON & (~bmSTRETCH)) | bmFW_STRETCH1);
+    sync_delay();
+    // Clear breakpoint register.
+    BREAKPT = 0;
+    sync_delay();
+    // Set all 8051 interrupts to low priority
+    IP = 0;
+    sync_delay();
+    // Clear interrupt enable bits.
+    EIE = 0;
+    sync_delay();
+    // Clear all external interrupt flags.
+    EXIF = 0;
+    sync_delay();
+}