setup.c 1.6 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10
/*
 * linux/arch/sh/boards/hp6xx/hp680/setup.c
 *
 * Copyright (C) 2002 Andriy Skulysh
 *
 * May be copied or modified under the terms of the GNU General Public
 * License.  See linux/COPYING for more information.
 *
 * Setup code for an HP680  (internal peripherials only)
 */
11
#include <linux/types.h>
L
Linus Torvalds 已提交
12
#include <linux/init.h>
13
#include <asm/hd64461.h>
14 15
#include <asm/io.h>
#include <asm/irq.h>
L
Linus Torvalds 已提交
16 17 18
#include <asm/hp6xx/hp6xx.h>
#include <asm/cpu/dac.h>

A
Andriy Skulysh 已提交
19 20 21
#define	SCPCR	0xa4000116
#define SCPDR	0xa4000136

L
Linus Torvalds 已提交
22 23
const char *get_system_type(void)
{
24
	return "HP6xx";
L
Linus Torvalds 已提交
25 26 27 28
}

int __init platform_setup(void)
{
29
	u8 v8;
L
Linus Torvalds 已提交
30
	u16 v;
A
Andriy Skulysh 已提交
31

L
Linus Torvalds 已提交
32 33 34 35 36 37
	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;
38 39 40
#ifndef CONFIG_HD64461_ENABLER
	v |= HD64461_STBCR_SPC1ST;
#endif
L
Linus Torvalds 已提交
41 42 43 44 45
	outw(v, HD64461_STBCR);
	v = inw(HD64461_GPADR);
	v |= HD64461_GPADR_SPEAKER | HD64461_GPADR_PCMCIA0;
	outw(v, HD64461_GPADR);

46 47 48 49 50 51 52
	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);
L
Linus Torvalds 已提交
53
	sh_dac_disable(DAC_SPEAKER_VOLUME);
54 55 56
	v8 = ctrl_inb(DACR);
	v8 &= ~DACR_DAE;
	ctrl_outb(v8,DACR);
L
Linus Torvalds 已提交
57

A
Andriy Skulysh 已提交
58 59 60 61 62 63 64 65 66 67
	v8 = ctrl_inb(SCPDR);
	v8 |= SCPDR_TS_SCAN_X | SCPDR_TS_SCAN_Y;
	v8 &= ~SCPDR_TS_SCAN_ENABLE;
	ctrl_outb(v8, SCPDR);

	v = ctrl_inw(SCPCR);
	v &= ~SCPCR_TS_MASK;
	v |= SCPCR_TS_ENABLE;
	ctrl_outw(v, SCPCR);

L
Linus Torvalds 已提交
68 69
	return 0;
}