From 3442b5fdeb4f8dfef38977078c5c6e801dcc2b51 Mon Sep 17 00:00:00 2001
From: Pavel Pisa <pisa@cmp.felk.cvut.cz>
Date: Wed, 13 Feb 2019 21:59:29 +0100
Subject: Implemented three dials equivalent to MZ_APO RGB dials.

Tested with code compiled by Linux PIC based GCC compiler
with calling musl-libc sprintf function.

Signed-off-by: Pavel Pisa <pisa@cmp.felk.cvut.cz>
---
 qtmips_machine/peripspiled.cpp | 128 +++++++++++++++++++++++++++++++++++++++++
 1 file changed, 128 insertions(+)
 create mode 100644 qtmips_machine/peripspiled.cpp

(limited to 'qtmips_machine/peripspiled.cpp')

diff --git a/qtmips_machine/peripspiled.cpp b/qtmips_machine/peripspiled.cpp
new file mode 100644
index 0000000..f811714
--- /dev/null
+++ b/qtmips_machine/peripspiled.cpp
@@ -0,0 +1,128 @@
+// SPDX-License-Identifier: GPL-2.0+
+/*******************************************************************************
+ * QtMips - MIPS 32-bit Architecture Subset Simulator
+ *
+ * Implemented to support following courses:
+ *
+ *   B35APO - Computer Architectures
+ *   https://cw.fel.cvut.cz/wiki/courses/b35apo
+ *
+ *   B4M35PAP - Advanced Computer Architectures
+ *   https://cw.fel.cvut.cz/wiki/courses/b4m35pap/start
+ *
+ * Copyright (c) 2017-2019 Karel Koci<cynerd@email.cz>
+ * Copyright (c) 2019      Pavel Pisa <pisa@cmp.felk.cvut.cz>
+ *
+ * Faculty of Electrical Engineering (http://www.fel.cvut.cz)
+ * Czech Technical University        (http://www.cvut.cz/)
+ *
+ * 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 program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin Street, Fifth Floor,
+ * Boston, MA  02110-1301, USA.
+ *
+ ******************************************************************************/
+
+#include "peripspiled.h"
+
+using namespace machine;
+
+#define SPILED_REG_LED_LINE_o           0x004
+#define SPILED_REG_LED_RGB1_o           0x010
+#define SPILED_REG_LED_RGB2_o           0x014
+#define SPILED_REG_LED_KBDWR_DIRECT_o   0x018
+
+#define SPILED_REG_KBDRD_KNOBS_DIRECT_o 0x020
+#define SPILED_REG_KNOBS_8BIT_o         0x024
+
+PeripSpiLed::PeripSpiLed() {
+
+}
+
+PeripSpiLed::~PeripSpiLed() {
+
+}
+
+bool PeripSpiLed::wword(std::uint32_t address, std::uint32_t value) {
+#if 0
+    printf("PeripSpiLed::wword address 0x%08lx data 0x%08lx\n",
+           (unsigned long)address, (unsigned long)value);
+#endif
+    switch (address) {
+    case  SPILED_REG_LED_LINE_o:
+        spiled_reg_led_line = value;
+        break;
+    case  SPILED_REG_LED_RGB1_o:
+        spiled_reg_led_rgb1 = value;
+        break;
+    case  SPILED_REG_LED_RGB2_o:
+        spiled_reg_led_rgb2 = value;
+        break;
+    default:
+        break;
+    }
+
+    emit write_notification(address, value);
+
+    return true;
+}
+
+std::uint32_t PeripSpiLed::rword(std::uint32_t address, bool debug_access) const {
+    (void)debug_access;
+    std::uint32_t value = 0x00000000;
+#if 0
+    printf("PeripSpiLed::rword address 0x%08lx\n",
+           (unsigned long)address);
+#endif
+    switch (address) {
+    case  SPILED_REG_LED_LINE_o:
+        value = spiled_reg_led_line;
+        break;
+    case  SPILED_REG_LED_RGB1_o:
+        value = spiled_reg_led_rgb1;
+        break;
+    case  SPILED_REG_LED_RGB2_o:
+        value = spiled_reg_led_rgb2;
+        break;
+    case  SPILED_REG_LED_KBDWR_DIRECT_o:
+        value = spiled_reg_led_kbdwr_direct;
+        break;
+    case  SPILED_REG_KBDRD_KNOBS_DIRECT_o:
+        value = spiled_reg_kbdrd_knobs_direct;
+        break;
+    case  SPILED_REG_KNOBS_8BIT_o:
+        value = spiled_reg_knobs_8bit;
+        break;
+    default:
+        break;
+    }
+
+    emit read_notification(address, &value);
+
+    return value;
+}
+
+void PeripSpiLed::red_knob_update(int val) {
+    spiled_reg_knobs_8bit &= ~(0xff << 16);
+    spiled_reg_knobs_8bit |= (val & 0xff) << 16;
+}
+
+void PeripSpiLed::green_knob_update(int val) {
+    spiled_reg_knobs_8bit &= ~(0xff << 8);
+    spiled_reg_knobs_8bit |= (val & 0xff) << 8;
+}
+
+void PeripSpiLed::blue_knob_update(int val) {
+    spiled_reg_knobs_8bit &= ~(0xff << 0);
+    spiled_reg_knobs_8bit |= (val & 0xff) << 0;
+}
-- 
cgit v1.2.3