root/arch/sh/boards/mach-hp6xx/setup.c
// SPDX-License-Identifier: GPL-2.0
/*
 * linux/arch/sh/boards/hp6xx/setup.c
 *
 * Copyright (C) 2002 Andriy Skulysh
 * Copyright (C) 2007 Kristoffer Ericson <Kristoffer_e1@hotmail.com>
 *
 * Setup code for HP620/HP660/HP680/HP690 (internal peripherials only)
 */
#include <linux/types.h>
#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/irq.h>
#include <linux/sh_intc.h>
#include <sound/sh_dac_audio.h>
#include <asm/hd64461.h>
#include <asm/io.h>
#include <mach/hp6xx.h>
#include <cpu/dac.h>

#define SCPCR   0xa4000116
#define SCPDR   0xa4000136

/* CF Slot */
static struct resource cf_ide_resources[] = {
        [0] = {
                .start = 0x15000000 + 0x1f0,
                .end   = 0x15000000 + 0x1f0 + 0x08 - 0x01,
                .flags = IORESOURCE_MEM,
        },
        [1] = {
                .start = 0x15000000 + 0x1fe,
                .end   = 0x15000000 + 0x1fe + 0x01,
                .flags = IORESOURCE_MEM,
        },
        [2] = {
                .start = evt2irq(0xba0),
                .flags = IORESOURCE_IRQ,
        },
};

static struct platform_device cf_ide_device = {
        .name           =  "pata_platform",
        .id             =  -1,
        .num_resources  = ARRAY_SIZE(cf_ide_resources),
        .resource       = cf_ide_resources,
};

static struct platform_device jornadakbd_device = {
        .name           = "jornada680_kbd",
        .id             = -1,
};

static void dac_audio_start(struct dac_audio_pdata *pdata)
{
        u16 v;
        u8 v8;

        /* HP Jornada 680/690 speaker on */
        v = inw(HD64461_GPADR);
        v &= ~HD64461_GPADR_SPEAKER;
        outw(v, HD64461_GPADR);

        /* HP Palmtop 620lx/660lx speaker on */
        v8 = inb(PKDR);
        v8 &= ~PKDR_SPEAKER;
        outb(v8, PKDR);

        sh_dac_enable(pdata->channel);
}

static void dac_audio_stop(struct dac_audio_pdata *pdata)
{
        u16 v;
        u8 v8;

        /* HP Jornada 680/690 speaker off */
        v = inw(HD64461_GPADR);
        v |= HD64461_GPADR_SPEAKER;
        outw(v, HD64461_GPADR);

        /* HP Palmtop 620lx/660lx speaker off */
        v8 = inb(PKDR);
        v8 |= PKDR_SPEAKER;
        outb(v8, PKDR);

        sh_dac_output(0, pdata->channel);
        sh_dac_disable(pdata->channel);
}

static struct dac_audio_pdata dac_audio_platform_data = {
        .buffer_size            = 64000,
        .channel                = 1,
        .start                  = dac_audio_start,
        .stop                   = dac_audio_stop,
};

static struct platform_device dac_audio_device = {
        .name           = "dac_audio",
        .id             = -1,
        .dev            = {
                .platform_data  = &dac_audio_platform_data,
        }

};

static struct platform_device *hp6xx_devices[] __initdata = {
        &cf_ide_device,
        &jornadakbd_device,
        &dac_audio_device,
};

static void __init hp6xx_init_irq(void)
{
        /* Gets touchscreen and powerbutton IRQ working */
        plat_irq_setup_pins(IRQ_MODE_IRQ);
}

static int __init hp6xx_devices_setup(void)
{
        return platform_add_devices(hp6xx_devices, ARRAY_SIZE(hp6xx_devices));
}

static void __init hp6xx_setup(char **cmdline_p)
{
        u8 v8;
        u16 v;

        v = inw(HD64461_STBCR);
        v |=    HD64461_STBCR_SURTST | HD64461_STBCR_SIRST      |
                HD64461_STBCR_STM1ST | HD64461_STBCR_STM0ST     |
                HD64461_STBCR_SAFEST | HD64461_STBCR_SPC0ST     |
                HD64461_STBCR_SMIAST | HD64461_STBCR_SAFECKE_OST|
                HD64461_STBCR_SAFECKE_IST;
#ifndef CONFIG_HD64461_ENABLER
        v |= HD64461_STBCR_SPC1ST;
#endif
        outw(v, HD64461_STBCR);
        v = inw(HD64461_GPADR);
        v |= HD64461_GPADR_SPEAKER | HD64461_GPADR_PCMCIA0;
        outw(v, HD64461_GPADR);

        outw(HD64461_PCCGCR_VCC0 | HD64461_PCCSCR_VCC1, HD64461_PCC0GCR);

#ifndef CONFIG_HD64461_ENABLER
        outw(HD64461_PCCGCR_VCC0 | HD64461_PCCSCR_VCC1, HD64461_PCC1GCR);
#endif

        sh_dac_output(0, DAC_SPEAKER_VOLUME);
        sh_dac_disable(DAC_SPEAKER_VOLUME);
        v8 = __raw_readb(DACR);
        v8 &= ~DACR_DAE;
        __raw_writeb(v8,DACR);

        v8 = __raw_readb(SCPDR);
        v8 |= SCPDR_TS_SCAN_X | SCPDR_TS_SCAN_Y;
        v8 &= ~SCPDR_TS_SCAN_ENABLE;
        __raw_writeb(v8, SCPDR);

        v = __raw_readw(SCPCR);
        v &= ~SCPCR_TS_MASK;
        v |= SCPCR_TS_ENABLE;
        __raw_writew(v, SCPCR);
}
device_initcall(hp6xx_devices_setup);

static struct sh_machine_vector mv_hp6xx __initmv = {
        .mv_name = "hp6xx",
        .mv_setup = hp6xx_setup,
        /* Enable IRQ0 -> IRQ3 in IRQ_MODE */
        .mv_init_irq = hp6xx_init_irq,
};