/*
 * Copyright (c) 2018-2019 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 <switch.h>
#include "fatal_task_sound.hpp"


void StopSoundTask::StopSound() {
    /* Talk to the ALC5639 over I2C, and disable audio output. */
    {
        I2cSession audio;
        if (R_SUCCEEDED(i2cOpenSession(&audio, I2cDevice_Alc5639))) {
            struct {
                u16 dev;
                u8 val;
            } __attribute__((packed)) cmd;
            static_assert(sizeof(cmd) == 3, "I2C command definition!");

            cmd.dev = 0xC801;
            cmd.val = 200;
            i2csessionSendAuto(&audio, &cmd, sizeof(cmd), I2cTransactionOption_All);

            cmd.dev = 0xC802;
            cmd.val = 200;
            i2csessionSendAuto(&audio, &cmd, sizeof(cmd), I2cTransactionOption_All);

            cmd.dev = 0xC802;
            cmd.val = 200;
            i2csessionSendAuto(&audio, &cmd, sizeof(cmd), I2cTransactionOption_All);
            
            for (u16 dev = 97; dev <= 102; dev++) {
                cmd.dev = dev;
                cmd.val = 0;
                i2csessionSendAuto(&audio, &cmd, sizeof(cmd), I2cTransactionOption_All);
            }
            
            i2csessionClose(&audio);
        }
    }
    
    /* Talk to the ALC5639 over GPIO, and disable audio output */
    {
        GpioPadSession audio;
        if (R_SUCCEEDED(gpioOpenSession(&audio, GpioPadName_AudioCodec))) {
            /* Set direction output, sleep 200 ms so it can take effect. */
            gpioPadSetDirection(&audio, GpioDirection_Output);
            svcSleepThread(200000000UL);
            
            /* Pull audio codec low. */
            gpioPadSetValue(&audio, GpioValue_Low);
            
            gpioPadClose(&audio);
        }
    }
}

Result StopSoundTask::Run() {
    StopSound();
    return ResultSuccess;
}