ams-mtc: add ams-mtc

Source/Atmosphere-MTC-Unlock/stratosphere/fatal/source/fatal_task_sound.cpp

@@ -0,0 +1,95 @@
+/*
+ * Copyright (c) Atmosphère-NX
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms and conditions of the GNU General Public License,
+ * version 2, as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope 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, see <http://www.gnu.org/licenses/>.
+ */
+#include <stratosphere.hpp>
+#include "fatal_task_sound.hpp"
+
+namespace ams::fatal::srv {
+
+    namespace {
+
+        /* Task definition. */
+        class StopSoundTask : public ITaskWithDefaultStack {
+            private:
+                void StopSound();
+            public:
+                virtual Result Run() override;
+                virtual const char *GetName() const override {
+                    return "SoundTask";
+                }
+        };
+
+        /* Task global. */
+        StopSoundTask g_stop_sound_task;
+
+        /* Task implementation. */
+        void StopSoundTask::StopSound() {
+            /* Talk to the ALC5639 over I2C, and disable audio output. */
+            {
+                I2cSession audio;
+                if (R_SUCCEEDED(i2cOpenSession(std::addressof(audio), I2cDevice_Alc5639))) {
+                    ON_SCOPE_EXIT { i2csessionClose(std::addressof(audio)); };
+
+                    struct {
+                        u8 reg;
+                        u16 val;
+                    } __attribute__((packed)) cmd;
+                    static_assert(sizeof(cmd) == 3, "I2C command definition!");
+
+                    cmd.reg = 0x01;
+                    cmd.val = 0xC8C8;
+                    i2csessionSendAuto(std::addressof(audio), std::addressof(cmd), sizeof(cmd), I2cTransactionOption_All);
+
+                    cmd.reg = 0x02;
+                    cmd.val = 0xC8C8;
+                    i2csessionSendAuto(std::addressof(audio), std::addressof(cmd), sizeof(cmd), I2cTransactionOption_All);
+
+                    for (u8 reg = 97; reg <= 102; reg++) {
+                        cmd.reg = reg;
+                        cmd.val = 0;
+                        i2csessionSendAuto(std::addressof(audio), std::addressof(cmd), sizeof(cmd), I2cTransactionOption_All);
+                    }
+                }
+            }
+
+            /* Talk to the ALC5639 over GPIO, and disable audio output */
+            {
+                gpio::GpioPadSession audio;
+                if (R_SUCCEEDED(gpio::OpenSession(std::addressof(audio), gpio::DeviceCode_CodecLdoEnTemp))) {
+                    ON_SCOPE_EXIT { gpio::CloseSession(std::addressof(audio)); };
+
+                    /* Set direction output, sleep 200 ms so it can take effect. */
+                    gpio::SetDirection(std::addressof(audio), gpio::Direction_Output);
+                    os::SleepThread(TimeSpan::FromMilliSeconds(200));
+
+                    /* Pull audio codec low. */
+                    gpio::SetValue(std::addressof(audio), gpio::GpioValue_Low);
+                }
+            }
+        }
+
+        Result StopSoundTask::Run() {
+            StopSound();
+            R_SUCCEED();
+        }
+
+    }
+
+    ITask *GetStopSoundTask(const ThrowContext *ctx) {
+        g_stop_sound_task.Initialize(ctx);
+        return std::addressof(g_stop_sound_task);
+    }
+
+}