patch-2.4.9 linux/arch/arm/mach-sa1100/sa1111.c

• Lines: 325
• Date: Sun Aug 12 17:36:24 2001
• Orig file: v2.4.8/linux/arch/arm/mach-sa1100/sa1111.c
• Orig date: Wed Dec 31 16:00:00 1969

diff -u --recursive --new-file v2.4.8/linux/arch/arm/mach-sa1100/sa1111.c linux/arch/arm/mach-sa1100/sa1111.c
@@ -0,0 +1,324 @@
+/*
+ * linux/arch/arm/mach-sa1100/sa1111.c
+ *
+ * SA1111 support
+ *
+ * Original code by John Dorsey
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ *
+ * This file contains all generic SA1111 support, except for DMA which is
+ * provided separately in dma-sa1111.c.
+ *
+ * All initialization functions provided here are intended to be called
+ * from machine specific code with proper arguments when required.
+ */
+
+#include <linux/init.h>
+#include <linux/kernel.h>
+#include <linux/delay.h>
+#include <linux/sched.h>
+#include <linux/interrupt.h>
+#include <linux/ptrace.h>
+#include <linux/errno.h>
+#include <linux/pci.h>
+#include <linux/mm.h>
+
+#include <asm/hardware.h>
+#include <asm/irq.h>
+#include <asm/mach/irq.h>
+#include <asm/arch/irq.h>
+
+#include "sa1111.h"
+
+static int sa1111_ohci_hcd_init(void);
+
+/*
+ * SA1111 initialization
+ */
+
+int __init sa1111_init(void)
+{
+	unsigned long id = SKID;
+
+	if((id & SKID_ID_MASK) == SKID_SA1111_ID)
+		printk( KERN_INFO "SA-1111 Microprocessor Companion Chip: "
+			"silicon revision %lx, metal revision %lx\n",
+			(id & SKID_SIREV_MASK)>>4, (id & SKID_MTREV_MASK));
+	else {
+		printk(KERN_ERR "Could not detect SA-1111!\n");
+		return -EINVAL;
+	}
+
+	/*
+	 * First, set up the 3.6864MHz clock on GPIO 27 for the SA-1111:
+	 * (SA-1110 Developer's Manual, section 9.1.2.1)
+	 */
+	GAFR |= GPIO_32_768kHz;
+	GPDR |= GPIO_32_768kHz;
+	TUCR = TUCR_3_6864MHz;
+
+	/* Now, set up the PLL and RCLK in the SA-1111: */
+	SKCR = SKCR_PLL_BYPASS | SKCR_RDYEN | SKCR_OE_EN;
+	udelay(100);
+	SKCR = SKCR_PLL_BYPASS | SKCR_RCLKEN | SKCR_RDYEN | SKCR_OE_EN;
+
+	/*
+	 * SA-1111 Register Access Bus should now be available. Clocks for
+	 * any other SA-1111 functional blocks must be enabled separately
+	 * using the SKPCR.
+	 */
+
+	/*
+	 * If the system is going to use the SA-1111 DMA engines, set up
+	 * the memory bus request/grant pins. Also configure the shared
+	 * memory controller on the SA-1111 (SA-1111 Developer's Manual,
+	 * section 3.2.3) and power up the DMA bus clock:
+	 */
+	GAFR |= (GPIO_MBGNT | GPIO_MBREQ);
+	GPDR |= GPIO_MBGNT;
+	GPDR &= ~GPIO_MBREQ;
+	TUCR |= TUCR_MR;
+
+#ifdef CONFIG_USB_OHCI
+	/* setup up sa1111 usb host controller h/w */
+	sa1111_ohci_hcd_init();
+#endif
+
+	return 0;
+}
+
+
+/*
+ * SA1111  Interrupt support
+ */
+
+void sa1111_IRQ_demux( int irq, void *dev_id, struct pt_regs *regs )
+{
+	int i;
+	unsigned long stat0, stat1;
+
+	for(;;) {
+		stat0 = INTSTATCLR0, stat1 = INTSTATCLR1;
+		if( !stat0 && !stat1 ) break;
+		if( stat0 )
+			for( i = 0; i < 32; i++ )
+				if( stat0 & (1<<i) )
+					do_IRQ( SA1111_IRQ(i), regs );
+
+		if( stat1 )
+			for( i = 32; i < 55; i++ )
+				if( stat1 & (1<<(i-32)) )
+					do_IRQ( SA1111_IRQ(i), regs );
+	}
+}
+
+static struct irqaction sa1111_irq = {
+	name:		"SA1111",
+	handler:	sa1111_IRQ_demux,
+	flags:		SA_INTERRUPT
+};
+
+static void sa1111_mask_and_ack_lowirq(unsigned int irq)
+{
+	unsigned int mask = 1 << (irq - SA1111_IRQ(0));
+
+	// broken hardware: interrupt events are lost if they occur
+	// while the interrupts are disabled.
+	//INTEN0 &= ~mask;
+	INTSTATCLR0 = mask;
+}
+
+static void sa1111_mask_and_ack_highirq(unsigned int irq)
+{
+	unsigned int mask = 1 << (irq - SA1111_IRQ(32));
+
+	//INTEN1 &= ~mask;
+	INTSTATCLR1 = mask;
+}
+
+static void sa1111_mask_lowirq(unsigned int irq)
+{
+	//INTEN0 &= ~(1 << (irq - SA1111_IRQ(0)));
+}
+
+static void sa1111_mask_highirq(unsigned int irq)
+{
+	//INTEN1 &= ~(1 << (irq - SA1111_IRQ(32)));
+}
+
+static void sa1111_unmask_lowirq(unsigned int irq)
+{
+	INTEN0 |= 1 << (irq - SA1111_IRQ(0));
+}
+
+static void sa1111_unmask_highirq(unsigned int irq)
+{
+	INTEN1 |= 1 << ((irq - SA1111_IRQ(32)));
+}
+
+void __init sa1111_init_irq(int gpio_nr)
+{
+	int irq;
+
+	/* disable all IRQs */
+	INTEN0 = 0;
+	INTEN1 = 0;
+
+	/*
+	 * detect on rising edge.  Note: Feb 2001 Errata for SA1111
+	 * specifies that S0ReadyInt and S1ReadyInt should be '1'.
+	 */
+	INTPOL0 = 0;
+	INTPOL1 = 1 << (S0_READY_NINT - SA1111_IRQ(32)) |
+		  1 << (S1_READY_NINT - SA1111_IRQ(32));
+
+	/* clear all IRQs */
+	INTSTATCLR0 = -1;
+	INTSTATCLR1 = -1;
+
+	for (irq = SA1111_IRQ(0); irq <= SA1111_IRQ(26); irq++) {
+		irq_desc[irq].valid	= 1;
+		irq_desc[irq].probe_ok	= 1;
+		irq_desc[irq].mask_ack	= sa1111_mask_and_ack_lowirq;
+		irq_desc[irq].mask	= sa1111_mask_lowirq;
+		irq_desc[irq].unmask	= sa1111_unmask_lowirq;
+	}
+	for (irq = SA1111_IRQ(32); irq <= SA1111_IRQ(54); irq++) {
+		irq_desc[irq].valid	= 1;
+		irq_desc[irq].probe_ok	= 1;
+		irq_desc[irq].mask_ack	= sa1111_mask_and_ack_highirq;
+		irq_desc[irq].mask	= sa1111_mask_highirq;
+		irq_desc[irq].unmask	= sa1111_unmask_highirq;
+	}
+
+	/* Not every machines has the SA1111 interrupt routed to a GPIO */
+	if (gpio_nr >= 0) {
+		set_GPIO_IRQ_edge (GPIO_GPIO(gpio_nr), GPIO_RISING_EDGE);
+		setup_arm_irq (SA1100_GPIO_TO_IRQ(gpio_nr), &sa1111_irq);
+	}
+}
+
+/* ----------------- */
+
+#ifdef CONFIG_USB_OHCI
+
+#if defined(CONFIG_SA1100_XP860) || defined(CONFIG_ASSABET_NEPONSET) || defined(CONFIG_SA1100_PFS168)
+#define PwrSensePolLow  1
+#define PwrCtrlPolLow   1
+#else
+#define PwrSensePolLow  0
+#define PwrCtrlPolLow   0
+#endif
+
+/*
+ * The SA-1111 errata says that the DMA hardware needs to be exercised
+ * before the clocks are turned on to work properly.  This code does
+ * a tiny dma transfer to prime to hardware.
+ */
+static void __init sa1111_dma_setup(void)
+{
+	dma_addr_t vbuf;
+	void * pbuf;
+
+	/* DMA init & setup */
+
+	/* WARNING: The SA-1111 L3 function is used as part of this
+	 * SA-1111 DMA errata workaround.
+	 *
+	 * N.B., When the L3 function is enabled, it uses GPIO_B<4:5>
+	 * and takes precedence over the PS/2 mouse and GPIO_B
+	 * functions. Refer to "Intel StrongARM SA-1111 Microprocessor
+	 * Companion Chip, Sect 10.2" for details.  So this "fix" may
+	 * "break" support of either PS/2 mouse or GPIO_B if
+	 * precautions are not taken to avoid collisions in
+	 * configuration and use of these pins. AFAIK, no precautions
+	 * are taken at this time. So it is likely that the action
+	 * taken here may cause problems in PS/2 mouse and/or GPIO_B
+	 * pin use elsewhere.
+	 *
+	 * But wait, there's more... What we're doing here is
+	 * obviously altogether a bad idea. We're indiscrimanately bit
+	 * flipping config for a few different functions here which
+	 * are "owned" by other drivers. This needs to be handled
+	 * better than it is being done here at this time.  */
+
+	/* prime the dma engine with a tiny dma */
+	SKPCR |= SKPCR_I2SCLKEN;
+	SKAUD |= SKPCR_L3CLKEN | SKPCR_SCLKEN;
+
+	SACR0 |= 0x00003305;
+	SACR1 = 0x00000000;
+
+	/* we need memory below 1mb */
+	pbuf = consistent_alloc(GFP_KERNEL | GFP_DMA, 4, &vbuf);
+
+	SADTSA = (unsigned long)pbuf;
+	SADTCA = 4;
+
+	SADTCS |= 0x00000011;
+	SKPCR |= SKPCR_DCLKEN;
+
+	/* wait */
+	udelay(100);
+
+	SACR0 &= ~(0x00000002);
+	SACR0 &= ~(0x00000001);
+
+	/* */
+	SACR0 |= 0x00000004;
+	SACR0 &= ~(0x00000004);
+
+	SKAUD &= ~(SKPCR_L3CLKEN | SKPCR_SCLKEN);
+
+	SKPCR &= ~SKPCR_I2SCLKEN;
+
+	consistent_free(pbuf, 4, vbuf);
+}
+
+#ifdef CONFIG_USB_OHCI
+/*
+ * reset the SA-1111 usb controller and turn on it's clocks
+ */
+static int __init sa1111_ohci_hcd_init(void)
+{
+	volatile unsigned long *Reset = (void *)SA1111_p2v(_SA1111(0x051c));
+	volatile unsigned long *Status = (void *)SA1111_p2v(_SA1111(0x0518));
+
+	/* turn on clocks */
+	SKPCR |= SKPCR_UCLKEN;
+	udelay(100);
+
+	/* force a reset */
+	*Reset = 0x01;
+	*Reset |= 0x02;
+	udelay(100);
+
+	*Reset = 0;
+
+	/* take out of reset */
+	/* set power sense and control lines (this from the diags code) */
+        *Reset = ( PwrSensePolLow << 6 )
+               | ( PwrCtrlPolLow << 7 );
+
+	*Status = 0;
+
+	udelay(10);
+
+	/* compensate for dma bug */
+	sa1111_dma_setup();
+
+	return 0;
+}
+
+void sa1111_ohci_hcd_cleanup(void)
+{
+	/* turn the USB clock off */
+	SKPCR &= ~SKPCR_UCLKEN;
+}
+#endif
+
+
+#endif /* CONFIG_USB_OHCI */