[PATCH 6/6] [RFC] POWERPC: Add mpc8560 board support

Vitaly Bordug vbordug at ru.mvista.com
Sun Jun 25 03:17:08 EST 2006


На Sat, 24 Jun 2006 11:26:01 -0500
Kumar Gala <galak at kernel.crashing.org> записано:

> 
> On Jun 23, 2006, at 6:17 PM, Vitaly Bordug wrote:
> 
> >
> > This enables the mpc8560-specific bits in powerpc. The relevant  
> > cpm2 PIC
> > and common utility were moved without or with minor changes,
> > hereby not all
> > the stuff have OF power utilized. Current functionality depends on  
> > the very
> > latest fs_enet update, that will go through netdev (cc'd here as
> > reference). Assuming all the preceeding stuff applied (PAL+fs_enet  
> > related
> > + CPM_UART update), the both TSEC eth ,FCC Eths, and both SCC
> > UARTs are
> > working. The relevant drivers are still capable to drive users in
> > ppc, which was verified with 8272ADS (SCC uart+FCC eth).
> >
> > Signed-off-by: Vitaly Bordug <vbordug at ru.mvista.com>
> 
> Can you break this patch up into its pieces (moving of cpm2* files),  
> fsl_soc mods, 8560 additions.

OK.
> 
> > ---
> >
> >  arch/powerpc/lib/Makefile                 |    5 +
> >  arch/powerpc/platforms/85xx/Kconfig       |   11 +
> >  arch/powerpc/platforms/85xx/Makefile      |    1
> >  arch/powerpc/platforms/85xx/mpc8560_ads.h |   54 +++++
> >  arch/powerpc/platforms/85xx/mpc85xx_ads.c |  107 +++++++++++
> >  arch/powerpc/sysdev/Makefile              |    7 +
> >  arch/powerpc/sysdev/cpm2_common.c         |  197
> > ++++++++++++++++++++ arch/powerpc/sysdev/cpm2_pic.c            |
> > 181 ++++++++++++++++++ arch/powerpc/sysdev/cpm2_pic.h
> > |    8 + arch/powerpc/sysdev/fsl_soc.c             |  290
> > ++++++++++++++++++ +++++++++++
> >  include/asm-ppc/cpm2.h                    |    2
> >  11 files changed, 860 insertions(+), 3 deletions(-)
> >
> > diff --git a/arch/powerpc/lib/Makefile b/arch/powerpc/lib/Makefile
> > index ff70964..0993b3b 100644
> > --- a/arch/powerpc/lib/Makefile
> > +++ b/arch/powerpc/lib/Makefile
> > @@ -21,3 +21,8 @@ ifeq ($(CONFIG_PPC64),y)
> >  obj-$(CONFIG_SMP)	+= locks.o
> >  obj-$(CONFIG_DEBUG_KERNEL) += sstep.o
> >  endif
> > +
> > +# Temporary hack until we have migrated to asm-powerpc
> > +ifeq ($(ARCH),powerpc)
> > +obj-$(CONFIG_CPM2)	+= rheap.o
> > +endif
> 
> Why not just move the file and build in arch/powerpc/lib/ for both  
> arch/powerpc & arch/ppc.  Same goes for cpm_* files.
> 

Makes sense to me...
> > diff --git a/arch/powerpc/platforms/85xx/Kconfig b/arch/powerpc/ 
> > platforms/85xx/Kconfig
> > index 454fc53..3d440de 100644
> > --- a/arch/powerpc/platforms/85xx/Kconfig
> > +++ b/arch/powerpc/platforms/85xx/Kconfig
> > @@ -11,6 +11,12 @@ config MPC8540_ADS
> >  	help
> >  	  This option enables support for the MPC 8540 ADS board
> >
> > +config MPC8560_ADS
> > +	bool "Freescale MPC8560 ADS"
> > +	select DEFAULT_UIMAGE
> > +	help
> > +	  This option enables support for the MPC 8560 ADS board
> > +
> >  config MPC85xx_CDS
> >  	bool "Freescale MPC85xx CDS"
> >  	select DEFAULT_UIMAGE
> > @@ -25,6 +31,11 @@ config MPC8540
> >  	select PPC_UDBG_16550
> >  	select PPC_INDIRECT_PCI
> >  	default y if MPC8540_ADS || MPC85xx_CDS
> > +
> > +config MPC8560
> > +	bool
> > +	select PPC_INDIRECT_PCI
> > +	default y if MPC8560_ADS
> >
> >  config PPC_INDIRECT_PCI_BE
> >  	bool
> > diff --git a/arch/powerpc/platforms/85xx/Makefile b/arch/powerpc/ 
> > platforms/85xx/Makefile
> > index 7615aa5..282f5d0 100644
> > --- a/arch/powerpc/platforms/85xx/Makefile
> > +++ b/arch/powerpc/platforms/85xx/Makefile
> > @@ -3,4 +3,5 @@ # Makefile for the PowerPC 85xx linux ke
> >  #
> >  obj-$(CONFIG_PPC_85xx)	+= misc.o pci.o
> >  obj-$(CONFIG_MPC8540_ADS) += mpc85xx_ads.o
> > +obj-$(CONFIG_MPC8560_ADS) += mpc85xx_ads.o
> >  obj-$(CONFIG_MPC85xx_CDS) += mpc85xx_cds.o
> > diff --git a/arch/powerpc/platforms/85xx/mpc8560_ads.h b/arch/ 
> > powerpc/platforms/85xx/mpc8560_ads.h
> > new file mode 100644
> > index 0000000..4ebe710
> > --- /dev/null
> > +++ b/arch/powerpc/platforms/85xx/mpc8560_ads.h
> > @@ -0,0 +1,54 @@
> > +/*
> > + * MPC8560ADS board definitions
> > + *
> > + * Maintainer: Kumar Gala <galak at kernel.crashing.org>
> > + *
> > + * Copyright 2004 Freescale Semiconductor Inc.
> > + *
> > + * This program is free software; you can redistribute  it and/or  
> > modify it
> > + * under  the terms of  the GNU General  Public License as  
> > published by the
> > + * Free Software Foundation;  either version 2 of the  License,
> > or (at your
> > + * option) any later version.
> > + *
> > + */
> > +
> > +#ifndef __MACH_MPC8560ADS_H
> > +#define __MACH_MPC8560ADS_H
> > +
> > +#include <linux/config.h>
> > +#include <linux/initrd.h>
> > +
> > +#define BOARD_CCSRBAR		((uint)0xe0000000)
> > +#define BCSR_ADDR		((uint)0xf8000000)
> > +#define BCSR_SIZE		((uint)(32 * 1024))
> > +
> > +#define MPC85xx_CPM_OFFSET	(0x80000)
> > +
> > +/*XXX TODO: pull from OF*/
> > +#define CPM_MAP_ADDR		(BOARD_CCSRBAR +
> > MPC85xx_CPM_OFFSET) +
> > +/* PCI interrupt controller */
> > +#define PIRQA		MPC85xx_IRQ_EXT1
> > +#define PIRQB		MPC85xx_IRQ_EXT2
> > +#define PIRQC		MPC85xx_IRQ_EXT3
> > +#define PIRQD		MPC85xx_IRQ_EXT4
> > +
> > +/* FCC1 Clock Source Configuration.  These can be
> > + * redefined in the board specific file.
> > + *    Can only choose from CLK9-12 */
> > +#define F1_RXCLK       12
> > +#define F1_TXCLK       11
> > +
> > +/* FCC2 Clock Source Configuration.  These can be
> > + * redefined in the board specific file.
> > + *    Can only choose from CLK13-16 */
> > +#define F2_RXCLK       13
> > +#define F2_TXCLK       14
> > +
> > +/* FCC3 Clock Source Configuration.  These can be
> > + * redefined in the board specific file.
> > + *    Can only choose from CLK13-16 */
> > +#define F3_RXCLK       15
> > +#define F3_TXCLK       16
> > +
> > +#endif				/* __MACH_MPC8560ADS_H */
> > diff --git a/arch/powerpc/platforms/85xx/mpc85xx_ads.c b/arch/ 
> > powerpc/platforms/85xx/mpc85xx_ads.c
> > index 5eeff37..352d0ae 100644
> > --- a/arch/powerpc/platforms/85xx/mpc85xx_ads.c
> > +++ b/arch/powerpc/platforms/85xx/mpc85xx_ads.c
> > @@ -15,6 +15,7 @@ #include <linux/config.h>
> >  #include <linux/stddef.h>
> >  #include <linux/kernel.h>
> >  #include <linux/pci.h>
> > +#include <linux/interrupt.h>
> >  #include <linux/kdev_t.h>
> >  #include <linux/delay.h>
> >  #include <linux/seq_file.h>
> > @@ -30,6 +31,10 @@ #include <asm/mpic.h>
> >  #include <mm/mmu_decl.h>
> >  #include <asm/udbg.h>
> >
> > +#ifdef CONFIG_CPM2
> > +#include <asm/cpm2.h>
> > +#endif
> > +
> >  #include <sysdev/fsl_soc.h>
> >  #include "mpc85xx.h"
> >
> > @@ -121,8 +126,25 @@ mpc85xx_exclude_device(u_char bus, u_cha
> >  }
> >
> >  #endif /* CONFIG_PCI */
> > +
> > +#ifdef CONFIG_CPM2
> >
> > +static irqreturn_t cpm2_cascade(int irq, void *dev_id, struct  
> > pt_regs *regs)
> > +{
> > +	while ((irq = cpm2_get_irq(regs)) >= 0)
> > +		__do_IRQ(irq, regs);
> > +	return IRQ_HANDLED;
> > +}
> >
> > +static struct irqaction cpm2_irqaction = {
> > +	.handler = cpm2_cascade,
> > +	.flags = SA_INTERRUPT,
> > +	.mask = CPU_MASK_NONE,
> > +	.name = "cpm2_cascade",
> > +};
> > +
> 
> I'd prefer that we see Ben's new IRQ support before doing this, but  
> ok for now.
> 
> > +#endif /* CONFIG_CPM2 */
> > +
> >  void __init mpc85xx_ads_pic_init(void)
> >  {
> >  	struct mpic *mpic1;
> > @@ -158,15 +180,91 @@ void __init mpc85xx_ads_pic_init(void)
> >  	mpic_assign_isu(mpic1, 13, OpenPIC_PAddr + 0x10080);
> >  	mpic_assign_isu(mpic1, 14, OpenPIC_PAddr + 0x10100);
> >  	mpic_init(mpic1);
> > +
> > +#ifdef CONFIG_CPM2
> > +	/* Setup CPM2 PIC */
> > +
> > +        cpm2_init_IRQ();
> > +
> > +	setup_irq(MPC85xx_IRQ_CPM, &cpm2_irqaction);
> > +#endif
> >  }
> >
> >  /*
> >   * Setup the architecture
> > - */
> > + */
> > +static void init_fcc_ioports(void)
> > +{
> > +	struct immap *immap;
> > +	struct io_port *io;
> > +	u32 tempval;
> > +
> > +	immap = cpm2_immr;
> > +
> > +	io = &immap->im_ioport;
> > +	/* FCC2/3 are on the ports B/C. */
> > +	tempval = in_be32(&io->iop_pdirb);
> > +	tempval &= ~PB2_DIRB0;
> > +	tempval |= PB2_DIRB1;
> > +	out_be32(&io->iop_pdirb, tempval);
> > +
> > +	tempval = in_be32(&io->iop_psorb);
> > +	tempval &= ~PB2_PSORB0;
> > +	tempval |= PB2_PSORB1;
> > +	out_be32(&io->iop_psorb, tempval);
> > +
> > +	tempval = in_be32(&io->iop_pparb);
> > +	tempval |= (PB2_DIRB0 | PB2_DIRB1);
> > +	out_be32(&io->iop_pparb, tempval);
> > +
> > +	tempval = in_be32(&io->iop_pdirb);
> > +	tempval &= ~PB3_DIRB0;
> > +	tempval |= PB3_DIRB1;
> > +	out_be32(&io->iop_pdirb, tempval);
> > +
> > +	tempval = in_be32(&io->iop_psorb);
> > +	tempval &= ~PB3_PSORB0;
> > +	tempval |= PB3_PSORB1;
> > +	out_be32(&io->iop_psorb, tempval);
> > +
> > +	tempval = in_be32(&io->iop_pparb);
> > +	tempval |= (PB3_DIRB0 | PB3_DIRB1);
> > +	out_be32(&io->iop_pparb, tempval);
> > +
> > +	tempval = in_be32(&io->iop_pdirc);
> > +	tempval |= PC3_DIRC1;
> > +	out_be32(&io->iop_pdirc, tempval);
> > +
> > +	tempval = in_be32(&io->iop_pparc);
> > +	tempval |= PC3_DIRC1;
> > +	out_be32(&io->iop_pparc, tempval);
> > +
> > +	/* Port C has clocks......  */
> > +	tempval = in_be32(&io->iop_psorc);
> > +	tempval &= ~(CLK_TRX);
> > +	out_be32(&io->iop_psorc, tempval);
> > +
> > +	tempval = in_be32(&io->iop_pdirc);
> > +	tempval &= ~(CLK_TRX);
> > +	out_be32(&io->iop_pdirc, tempval);
> > +	tempval = in_be32(&io->iop_pparc);
> > +	tempval |= (CLK_TRX);
> > +	out_be32(&io->iop_pparc, tempval);
> > +
> > +	/* Configure Serial Interface clock routing.
> > +	 * First,  clear all FCC bits to zero,
> > +	 * then set the ones we want.
> > +	 */
> > +	immap->im_cpmux.cmx_fcr &= ~(CPMUX_CLK_MASK);
> > +	immap->im_cpmux.cmx_fcr |= CPMUX_CLK_ROUTE;
> > +}
> 
> Can this be turned into some library function that uses some input  
> that is board specific.  U-boot has a table that looked like a  
> reasonable approach.
> 

It's in TBD list, but not of high urgency fairly. The approach will be
what Dan suggested long ago - pmac-like feature_call that will behave
like sort of BSP ioctl(). Guess it will be good as a next step after
actual merge...

> > +
> >  static void __init mpc85xx_ads_setup_arch(void)
> >  {
> >  	struct device_node *cpu;
> >  	struct device_node *np;
> > +
> > +	cpm2_reset();
> >
> >  	if (ppc_md.progress)
> >  		ppc_md.progress("mpc85xx_ads_setup_arch()", 0);
> > @@ -184,8 +282,13 @@ static void __init mpc85xx_ads_setup_arc
> >  	}
> >
> >  #ifdef CONFIG_PCI
> > +
> >  	for (np = NULL; (np = of_find_node_by_type(np, "pci")) !=
> > NULL;) add_bridge(np);
> > +
> > +#ifdef CONFIG_CPM2
> > +	init_fcc_ioports();
> > +#endif
> 
> This appears to be inside the CONFIG_PCI #ifdef, is that really what  
> you want?
> 

touché :) Will fix...

> >  	ppc_md.pci_swizzle = common_swizzle;
> >  	ppc_md.pci_map_irq = mpc85xx_map_irq;
> > @@ -240,5 +343,7 @@ define_machine(mpc85xx_ads) {
> >  	.get_irq		= mpic_get_irq,
> >  	.restart		= mpc85xx_restart,
> >  	.calibrate_decr		= generic_calibrate_decr,
> > +#ifndef CONFIG_CPM2
> >  	.progress		= udbg_progress,
> > +#endif
> >  };
> > diff --git a/arch/powerpc/sysdev/Makefile b/arch/powerpc/sysdev/ 
> > Makefile
> > index cef95b0..75dfe12 100644
> > --- a/arch/powerpc/sysdev/Makefile
> > +++ b/arch/powerpc/sysdev/Makefile
> > @@ -12,3 +12,10 @@ obj-$(CONFIG_U3_DART)		+=
> > dart_iommu.o obj-$(CONFIG_MMIO_NVRAM)	+= mmio_nvram.o
> >  obj-$(CONFIG_PPC_83xx)		+= ipic.o
> >  obj-$(CONFIG_FSL_SOC)		+= fsl_soc.o
> > +
> > +# Temporary hack until we have migrated to asm-powerpc
> > +ifeq ($(ARCH),powerpc)
> > +obj-$(CONFIG_CPM2)		+= cpm2_common.o cpm2_pic.o
> > +endif
> 
> See earlier comments about just building in arch/powerpc
> 
Hrm, here I am not completely sure it's a good thing. The point is that
currently some OF-specific stuff is under construction to go into
cpm2_common at least (for instance, getting rid of CPM_MAP_ADDR
ioremap because the offset is available via oftree, and things like
that).

> > +
> > +#obj-$(CONFIG_CPM2)		+= cpm2/
> > Yuri diff --git a/arch/powerpc/sysdev/cpm2_common.c b/arch/powerpc/ 
> > sysdev/cpm2_common.c
> > new file mode 100644
> > index 0000000..c755f65
> > --- /dev/null
> > +++ b/arch/powerpc/sysdev/cpm2_common.c
> > @@ -0,0 +1,197 @@
> > +/*
> > + * General Purpose functions for the global management of the
> > + * 8260 Communication Processor Module.
> > + * Copyright (c) 1999 Dan Malek (dmalek at jlc.net)
> > + * Copyright (c) 2000 MontaVista Software, Inc (source at mvista.com)
> > + *	2.3.99 Updates
> > + *
> > + * In addition to the individual control of the communication
> > + * channels, there are a few functions that globally affect the
> > + * communication processor.
> > + *
> > + * Buffer descriptors must be allocated from the dual ported memory
> > + * space.  The allocator for that is here.  When the communication
> > + * process is reset, we reclaim the memory available.  There is
> > + * currently no deallocator for this memory.
> > + */
> > +#include <linux/errno.h>
> > +#include <linux/sched.h>
> > +#include <linux/kernel.h>
> > +#include <linux/param.h>
> > +#include <linux/string.h>
> > +#include <linux/mm.h>
> > +#include <linux/interrupt.h>
> > +#include <linux/module.h>
> > +#include <asm/io.h>
> > +#include <asm/irq.h>
> > +#include <asm/mpc8260.h>
> > +#include <asm/page.h>
> > +#include <asm/pgtable.h>
> > +#include <asm/cpm2.h>
> > +#include <asm/rheap.h>
> > +
> > +static void cpm2_dpinit(void);
> > +cpm_cpm2_t	*cpmp;		/* Pointer to comm
> > processor space */ +
> > +/* We allocate this here because it is used almost exclusively for
> > + * the communication processor devices.
> > + */
> > +cpm2_map_t *cpm2_immr;
> > +
> > +#define CPM_MAP_SIZE	(0x40000)	/* 256k - the PQ3
> > reserve this amount
> > +					   of space for CPM as it
> > is larger
> > +					   than on PQ2 */
> > +
> > +void
> > +cpm2_reset(void)
> > +{
> > +	cpm2_immr = (cpm2_map_t *)ioremap(CPM_MAP_ADDR,
> > CPM_MAP_SIZE);
> 
> You dont need the cast.
> 

Ok, but this is going to be changed as I said upper. We have enough info
in dts to make this more sane. Actually, I do not like the idea of
ioremapping the whole IMMR, but that improvements are for the future.
  
> > +
> > +	/* Reclaim the DP memory for our use.
> > +	 */
> > +	cpm2_dpinit();
> > +
> > +	/* Tell everyone where the comm processor resides.
> > +	 */
> > +	cpmp = &cpm2_immr->im_cpm;
> > +}
> > +
> > +/* Set a baud rate generator.  This needs lots of work.  There are
> > + * eight BRGs, which can be connected to the CPM channels or output
> > + * as clocks.  The BRGs are in two different block of internal
> > + * memory mapped space.
> > + * The baud rate clock is the system clock divided by something.
> > + * It was set up long ago during the initial boot phase and is
> > + * is given to us.
> > + * Baud rate clocks are zero-based in the driver code (as that maps
> > + * to port numbers).  Documentation uses 1-based numbering.
> > + */
> > +#define BRG_INT_CLK	(get_brgfreq())
> > +#define BRG_UART_CLK	(BRG_INT_CLK/16)
> > +
> > +/* This function is used by UARTS, or anything else that uses a 16x
> > + * oversampled clock.
> > + */
> > +void
> > +cpm_setbrg(uint brg, uint rate)
> > +{
> > +	volatile uint	*bp;
> > +
> > +	/* This is good enough to get SMCs running.....
> > +	*/
> > +	if (brg < 4) {
> > +		bp = (uint *)&cpm2_immr->im_brgc1;
> > +	}
> > +	else {
> > +		bp = (uint *)&cpm2_immr->im_brgc5;
> > +		brg -= 4;
> > +	}
> > +	bp += brg;
> > +	*bp = ((BRG_UART_CLK / rate) << 1) | CPM_BRG_EN;
> > +}
> > +
> > +/* This function is used to set high speed synchronous baud rate
> > + * clocks.
> > + */
> > +void
> > +cpm2_fastbrg(uint brg, uint rate, int div16)
> > +{
> > +	volatile uint	*bp;
> > +
> > +	if (brg < 4) {
> > +		bp = (uint *)&cpm2_immr->im_brgc1;
> > +	}
> > +	else {
> > +		bp = (uint *)&cpm2_immr->im_brgc5;
> > +		brg -= 4;
> > +	}
> > +	bp += brg;
> > +	*bp = ((BRG_INT_CLK / rate) << 1) | CPM_BRG_EN;
> > +	if (div16)
> > +		*bp |= CPM_BRG_DIV16;
> > +}
> > +
> > +/*
> > + * dpalloc / dpfree bits.
> > + */
> > +static spinlock_t cpm_dpmem_lock;
> > +/* 16 blocks should be enough to satisfy all requests
> > + * until the memory subsystem goes up... */
> > +static rh_block_t cpm_boot_dpmem_rh_block[16];
> > +static rh_info_t cpm_dpmem_info;
> > +
> > +static void cpm2_dpinit(void)
> > +{
> > +	spin_lock_init(&cpm_dpmem_lock);
> > +
> > +	/* initialize the info header */
> > +	rh_init(&cpm_dpmem_info, 1,
> > +			sizeof(cpm_boot_dpmem_rh_block) /
> > +			sizeof(cpm_boot_dpmem_rh_block[0]),
> > +			cpm_boot_dpmem_rh_block);
> > +
> > +	/* Attach the usable dpmem area */
> > +	/* XXX: This is actually crap. CPM_DATAONLY_BASE and
> > +	 * CPM_DATAONLY_SIZE is only a subset of the available
> > dpram. It
> > +	 * varies with the processor and the microcode patches
> > activated.
> > +	 * But the following should be at least safe.
> > +	 */
> > +	rh_attach_region(&cpm_dpmem_info, (void
> > *)CPM_DATAONLY_BASE,
> > +			CPM_DATAONLY_SIZE);
> > +}
> > +
> > +/* This function returns an index into the DPRAM area.
> > + */
> > +uint cpm_dpalloc(uint size, uint align)
> > +{
> > +	void *start;
> > +	unsigned long flags;
> > +
> > +	spin_lock_irqsave(&cpm_dpmem_lock, flags);
> > +	cpm_dpmem_info.alignment = align;
> > +	start = rh_alloc(&cpm_dpmem_info, size, "commproc");
> > +	spin_unlock_irqrestore(&cpm_dpmem_lock, flags);
> > +
> > +	return (uint)start;
> > +}
> > +EXPORT_SYMBOL(cpm_dpalloc);
> > +
> > +int cpm_dpfree(uint offset)
> > +{
> > +	int ret;
> > +	unsigned long flags;
> > +
> > +	spin_lock_irqsave(&cpm_dpmem_lock, flags);
> > +	ret = rh_free(&cpm_dpmem_info, (void *)offset);
> > +	spin_unlock_irqrestore(&cpm_dpmem_lock, flags);
> > +
> > +	return ret;
> > +}
> > +EXPORT_SYMBOL(cpm_dpfree);
> > +
> > +/* not sure if this is ever needed */
> > +uint cpm_dpalloc_fixed(uint offset, uint size, uint align)
> > +{
> > +	void *start;
> > +	unsigned long flags;
> > +
> > +	spin_lock_irqsave(&cpm_dpmem_lock, flags);
> > +	cpm_dpmem_info.alignment = align;
> > +	start = rh_alloc_fixed(&cpm_dpmem_info, (void *)offset,
> > size, "commproc");
> > +	spin_unlock_irqrestore(&cpm_dpmem_lock, flags);
> > +
> > +	return (uint)start;
> > +}
> > +EXPORT_SYMBOL(cpm_dpalloc_fixed);
> > +
> > +void cpm_dpdump(void)
> > +{
> > +	rh_dump(&cpm_dpmem_info);
> > +}
> > +EXPORT_SYMBOL(cpm_dpdump);
> > +
> > +void *cpm_dpram_addr(uint offset)
> > +{
> > +	return (void *)&cpm2_immr->im_dprambase[offset];
> > +}
> > +EXPORT_SYMBOL(cpm_dpram_addr);
> > diff --git a/arch/powerpc/sysdev/cpm2_pic.c b/arch/powerpc/sysdev/ 
> > cpm2_pic.c
> > new file mode 100644
> > index 0000000..e0db594
> > --- /dev/null
> > +++ b/arch/powerpc/sysdev/cpm2_pic.c
> > @@ -0,0 +1,181 @@
> > +/* The CPM2 internal interrupt controller.  It is usually
> > + * the only interrupt controller.
> > + * There are two 32-bit registers (high/low) for up to 64
> > + * possible interrupts.
> > + *
> > + * Now, the fun starts.....Interrupt Numbers DO NOT MAP
> > + * in a simple arithmetic fashion to mask or pending registers.
> > + * That is, interrupt 4 does not map to bit position 4.
> > + * We create two tables, indexed by vector number, to indicate
> > + * which register to use and which bit in the register to use.
> > + */
> > +
> > +#include <linux/stddef.h>
> > +#include <linux/init.h>
> > +#include <linux/sched.h>
> > +#include <linux/signal.h>
> > +#include <linux/irq.h>
> > +
> > +#include <asm/immap_cpm2.h>
> > +#include <asm/mpc8260.h>
> > +#include <asm/io.h>
> > +
> > +#include "cpm2_pic.h"
> > +
> > +static	u_char	irq_to_siureg[] = {
> > +	1, 1, 1, 1, 1, 1, 1, 1,
> > +	1, 1, 1, 1, 1, 1, 1, 1,
> > +	0, 0, 0, 0, 0, 0, 0, 0,
> > +	0, 0, 0, 0, 0, 0, 0, 0,
> > +	1, 1, 1, 1, 1, 1, 1, 1,
> > +	1, 1, 1, 1, 1, 1, 1, 1,
> > +	0, 0, 0, 0, 0, 0, 0, 0,
> > +	0, 0, 0, 0, 0, 0, 0, 0
> > +};
> > +
> > +/* bit numbers do not match the docs, these are precomputed so
> > the bit for
> > + * a given irq is (1 << irq_to_siubit[irq]) */
> > +static	u_char	irq_to_siubit[] = {
> > +	 0, 15, 14, 13, 12, 11, 10,  9,
> > +	 8,  7,  6,  5,  4,  3,  2,  1,
> > +	 2,  1,  0, 14, 13, 12, 11, 10,
> > +	 9,  8,  7,  6,  5,  4,  3,  0,
> > +	31, 30, 29, 28, 27, 26, 25, 24,
> > +	23, 22, 21, 20, 19, 18, 17, 16,
> > +	16, 17, 18, 19, 20, 21, 22, 23,
> > +	24, 25, 26, 27, 28, 29, 30, 31,
> > +};
> > +
> > +static void cpm2_mask_irq(unsigned int irq_nr)
> > +{
> > +	int	bit, word;
> > +	volatile uint	*simr;
> > +
> > +	irq_nr -= CPM_IRQ_OFFSET;
> > +
> > +	bit = irq_to_siubit[irq_nr];
> > +	word = irq_to_siureg[irq_nr];
> > +
> > +	simr = &(cpm2_immr->im_intctl.ic_simrh);
> > +	ppc_cached_irq_mask[word] &= ~(1 << bit);
> > +	simr[word] = ppc_cached_irq_mask[word];
> > +}
> > +
> > +static void cpm2_unmask_irq(unsigned int irq_nr)
> > +{
> > +	int	bit, word;
> > +	volatile uint	*simr;
> > +
> > +	irq_nr -= CPM_IRQ_OFFSET;
> > +
> > +	bit = irq_to_siubit[irq_nr];
> > +	word = irq_to_siureg[irq_nr];
> > +
> > +	simr = &(cpm2_immr->im_intctl.ic_simrh);
> > +	ppc_cached_irq_mask[word] |= 1 << bit;
> > +	simr[word] = ppc_cached_irq_mask[word];
> > +}
> > +
> > +static void cpm2_mask_and_ack(unsigned int irq_nr)
> > +{
> > +	int	bit, word;
> > +	volatile uint	*simr, *sipnr;
> > +
> > +	irq_nr -= CPM_IRQ_OFFSET;
> > +
> > +	bit = irq_to_siubit[irq_nr];
> > +	word = irq_to_siureg[irq_nr];
> > +
> > +	simr = &(cpm2_immr->im_intctl.ic_simrh);
> > +	sipnr = &(cpm2_immr->im_intctl.ic_sipnrh);
> > +	ppc_cached_irq_mask[word] &= ~(1 << bit);
> > +	simr[word] = ppc_cached_irq_mask[word];
> > +	sipnr[word] = 1 << bit;
> > +}
> > +
> > +static void cpm2_end_irq(unsigned int irq_nr)
> > +{
> > +	int	bit, word;
> > +	volatile uint	*simr;
> > +
> > +	if (!(irq_desc[irq_nr].status &
> > (IRQ_DISABLED|IRQ_INPROGRESS))
> > +			&& irq_desc[irq_nr].action) {
> > +
> > +		irq_nr -= CPM_IRQ_OFFSET;
> > +		bit = irq_to_siubit[irq_nr];
> > +		word = irq_to_siureg[irq_nr];
> > +
> > +		simr = &(cpm2_immr->im_intctl.ic_simrh);
> > +		ppc_cached_irq_mask[word] |= 1 << bit;
> > +		simr[word] = ppc_cached_irq_mask[word];
> > +		/*
> > +		 * Work around large numbers of spurious IRQs on
> > PowerPC 82xx
> > +		 * systems.
> > +		 */
> > +		mb();
> > +	}
> > +}
> > +
> > +static struct hw_interrupt_type cpm2_pic = {
> > +	.typename = " CPM2 SIU ",
> > +	.enable = cpm2_unmask_irq,
> > +	.disable = cpm2_mask_irq,
> > +	.ack = cpm2_mask_and_ack,
> > +	.end = cpm2_end_irq,
> > +};
> > +
> > +int cpm2_get_irq(struct pt_regs *regs)
> > +{
> > +	int irq;
> > +        unsigned long bits;
> > +
> > +        /* For CPM2, read the SIVEC register and shift the bits
> > down
> > +         * to get the irq number.         */
> > +        bits = cpm2_immr->im_intctl.ic_sivec;
> > +        irq = bits >> 26;
> > +
> > +	if (irq == 0)
> > +		return(-1);
> > +	return irq+CPM_IRQ_OFFSET;
> > +}
> > +
> > +void cpm2_init_IRQ(void)
> > +{
> > +	int i;
> > +	u32 addr;
> > +
> > +	/* Clear the CPM IRQ controller, in case it has any bits
> > set
> > +	 * from the bootloader
> > +	 */
> > +
> > +	/* Mask out everything */
> > +
> > +	cpm2_immr->im_intctl.ic_simrh = 0x00000000;
> > +	cpm2_immr->im_intctl.ic_simrl = 0x00000000;
> > +
> > +	wmb();
> > +
> > +	/* Ack everything */
> > +	cpm2_immr->im_intctl.ic_sipnrh = 0xffffffff;
> > +	cpm2_immr->im_intctl.ic_sipnrl = 0xffffffff;
> > +	wmb();
> > +
> > +	/* Dummy read of the vector */
> > +	i = cpm2_immr->im_intctl.ic_sivec;
> > +	rmb();
> > +
> > +	/* Initialize the default interrupt mapping priorities,
> > +	 * in case the boot rom changed something on us.
> > +	 */
> > +	cpm2_immr->im_intctl.ic_sicr = 0;
> > +	cpm2_immr->im_intctl.ic_scprrh = 0x05309770;
> > +	cpm2_immr->im_intctl.ic_scprrl = 0x05309770;
> > +
> > +
> > +	/* Enable chaining to OpenPIC, and make everything level
> > +	 */
> > +	for (i = 0; i < NR_CPM_INTS; i++) {
> > +		irq_desc[i+CPM_IRQ_OFFSET].handler = &cpm2_pic;
> > +		irq_desc[i+CPM_IRQ_OFFSET].status |= IRQ_LEVEL;
> > +	}
> > +}
> > diff --git a/arch/powerpc/sysdev/cpm2_pic.h b/arch/powerpc/sysdev/ 
> > cpm2_pic.h
> > new file mode 100644
> > index 0000000..97cab8f
> > --- /dev/null
> > +++ b/arch/powerpc/sysdev/cpm2_pic.h
> > @@ -0,0 +1,8 @@
> > +#ifndef _PPC_KERNEL_CPM2_H
> > +#define _PPC_KERNEL_CPM2_H
> > +
> > +extern int cpm2_get_irq(struct pt_regs *regs);
> > +
> > +extern void cpm2_init_IRQ(void);
> > +
> > +#endif /* _PPC_KERNEL_CPM2_H */
> > diff --git a/arch/powerpc/sysdev/fsl_soc.c b/arch/powerpc/sysdev/ 
> > fsl_soc.c
> > index ceb5846..bab202d 100644
> > --- a/arch/powerpc/sysdev/fsl_soc.c
> > +++ b/arch/powerpc/sysdev/fsl_soc.c
> > @@ -21,6 +21,8 @@ #include <linux/module.h>
> >  #include <linux/device.h>
> >  #include <linux/platform_device.h>
> >  #include <linux/fsl_devices.h>
> > +#include <linux/fs_enet_pd.h>
> > +#include <linux/fs_uart_pd.h>
> >
> >  #include <asm/system.h>
> >  #include <asm/atomic.h>
> > @@ -30,6 +32,10 @@ #include <asm/prom.h>
> >  #include <sysdev/fsl_soc.h>
> >  #include <mm/mmu_decl.h>
> >
> > +#ifdef CONFIG_CPM2
> > +#include <asm/cpm2.h>
> > +#endif
> > +
> >  static phys_addr_t immrbase = -1;
> >
> >  phys_addr_t get_immrbase(void)
> > @@ -43,7 +49,9 @@ phys_addr_t get_immrbase(void)
> >  	if (soc) {
> >  		unsigned int size;
> >  		void *prop = get_property(soc, "reg", &size);
> > -		immrbase = of_translate_address(soc, prop);
> > +
> > +		if (prop)
> > +			immrbase = of_translate_address(soc, prop);
> >  		of_node_put(soc);
> >  	};
> >
> > @@ -51,7 +59,79 @@ phys_addr_t get_immrbase(void)
> >  }
> >
> >  EXPORT_SYMBOL(get_immrbase);
> > +
> > +static u32 brgfreq = -1;
> > +
> > +u32 get_brgfreq(void)
> > +{
> > +	struct device_node *node;
> > +
> > +	if (brgfreq != -1)
> > +		return brgfreq;
> > +
> > +	node = of_find_node_by_type(NULL, "serial");
> > +	if (node) {
> > +		unsigned int size;
> > +		unsigned int *prop = (unsigned
> > int*)get_property(node, "clock- frequency", &size);
> > +
> > +		if (prop)
> > +			brgfreq = *prop;
> > +		of_node_put(node);
> > +	};
> > +
> > +	return brgfreq;
> > +}
> 
> These seems broken on a system w/both CPM & 8250 style uarts.
> 
Yeah, missed that.

> > +
> > +EXPORT_SYMBOL(get_brgfreq);
> > +
> > +static u32 fs_baudrate = -1;
> > +
> > +u32 get_baudrate(void)
> > +{
> > +	struct device_node *node;
> >
> > +	if (fs_baudrate != -1)
> > +		return fs_baudrate;
> > +
> > +	node = of_find_node_by_type(NULL, "serial");
> > +	if (node) {
> > +		unsigned int size;
> > +		unsigned int *prop = (unsigned
> > int*)get_property(node, "current- speed", &size);
> > +
> > +		if (prop)
> > +			fs_baudrate = *prop;
> > +		of_node_put(node);
> > +	};
> > +
> > +	return fs_baudrate;
> > +}
> > +
> > +EXPORT_SYMBOL(get_baudrate);
> > +
> > +static u32 intfreq = -1;
> > +
> > +u32 get_intfreq(void)
> > +{
> > +	struct device_node *node;
> > +
> > +	if (intfreq != -1)
> > +		return intfreq;
> > +
> > +	node = of_find_node_by_type(NULL, "cpu");
> > +	if (node) {
> > +		unsigned int size;
> > +		unsigned int *prop = (unsigned
> > int*)get_property(node, "clock- frequency", &size);
> > +		if (prop)
> > +			intfreq = *prop;
> > +		of_node_put(node);
> > +	}
> > +
> > +	return intfreq;
> > +}
> > +
> > +EXPORT_SYMBOL(get_intfreq);
> > +
> 
> Don't we have something that reports "clock-frequency" elsewhere?
> 

If yes, I haven't found... Mind pointing where to look at? 

> > +
> >  static int __init gfar_mdio_of_init(void)
> >  {
> >  	struct device_node *np;
> > @@ -491,3 +571,211 @@ err:
> >  }
> >
> >  arch_initcall(fsl_usb_dr_of_init);
> > +
> > +static const char *fcc_regs = "fcc_regs";
> > +static const char *fcc_regs_c = "fcc_regs_c";
> > +static const char *fcc_pram = "fcc_pram";
> > +static char bus_id[9][BUS_ID_SIZE];
> > +
> > +static int __init fs_enet_of_init(void)
> > +{
> > +	struct device_node *np;
> > +	unsigned int i;
> > +	struct platform_device *fs_enet_dev;
> > +	struct resource res;
> > +	int ret;
> > +
> > +	for (np = NULL, i = 0;
> > +	     (np = of_find_compatible_node(np, "network",
> > "fs_enet")) != NULL;
> > +	     i++) {
> > +		struct resource r[4];
> > +		struct device_node *phy, *mdio;
> > +		struct fs_platform_info fs_enet_data;
> > +		unsigned int *id, *phy_addr;
> > +		void *mac_addr;
> > +		phandle *ph;
> > +		char *model;
> > +
> > +		memset(r, 0, sizeof(r));
> > +		memset(&fs_enet_data, 0, sizeof(fs_enet_data));
> > +
> > +		ret = of_address_to_resource(np, 0, &r[0]);
> > +		if (ret)
> > +			goto err;
> > +		r[0].name = fcc_regs;
> > +
> > +		ret = of_address_to_resource(np, 1, &r[1]);
> > +		if (ret)
> > +			goto err;
> > +		r[1].name = fcc_pram;
> > +
> > +		ret = of_address_to_resource(np, 2, &r[2]);
> > +		if (ret)
> > +			goto err;
> > +		r[2].name = fcc_regs_c;
> > +
> > +		r[3].start = np->intrs[0].line;
> > +		r[3].end = np->intrs[0].line;
> > +		r[3].flags = IORESOURCE_IRQ;
> > +
> > +		fs_enet_dev =
> > +		    platform_device_register_simple("fsl-cpm-fcc",
> > i, &r[0], 4); +
> > +		if (IS_ERR(fs_enet_dev)) {
> > +			ret = PTR_ERR(fs_enet_dev);
> > +			goto err;
> > +		}
> > +
> > +		model = get_property(np, "model", NULL);
> > +		if (model == NULL) {
> > +			ret = -ENODEV;
> > +			goto unreg;
> > +		}
> > +
> > +		mac_addr = get_property(np, "mac-address", NULL);
> > +		memcpy(fs_enet_data.macaddr, mac_addr, 6);
> > +
> > +		ph = (phandle *) get_property(np, "phy-handle",
> > NULL);
> > +		phy = of_find_node_by_phandle(*ph);
> > +
> > +		if (phy == NULL) {
> > +			ret = -ENODEV;
> > +			goto unreg;
> > +		}
> > +
> > +		phy_addr = (u32 *) get_property(phy, "reg", NULL);
> > +		fs_enet_data.phy_addr = *phy_addr;
> > +
> > +		id = (u32 *) get_property(np, "device-id", NULL);
> > +		fs_enet_data.fs_no = *id;
> > +
> > +		mdio = of_get_parent(phy);
> > +                ret = of_address_to_resource(mdio, 0, &res);
> > +                if (ret) {
> > +                        of_node_put(phy);
> > +                        of_node_put(mdio);
> > +                        goto unreg;
> > +                }
> > +
> > +		switch (*id) {
> > +		case fsid_fcc1:
> > +			fs_enet_data.mem_offset = FCC1_MEM_OFFSET,
> > +			snprintf((char*)&bus_id[2], BUS_ID_SIZE,
> > "%x:%02x", (u32) res.start, fs_enet_data.phy_addr);
> > +			fs_enet_data.bus_id = (char*)&bus_id[2];
> > +			fs_enet_data.cp_page = CPM_CR_FCC1_PAGE;
> > +			fs_enet_data.cp_block = CPM_CR_FCC1_SBLOCK;
> > +			break;
> > +		case fsid_fcc2:
> > +			fs_enet_data.mem_offset = FCC2_MEM_OFFSET,
> > +			snprintf((char*)&bus_id[3], BUS_ID_SIZE,
> > "%x:%02x", (u32) res.start, fs_enet_data.phy_addr);
> > +			fs_enet_data.bus_id = (char*)&bus_id[3];
> > +			fs_enet_data.cp_page = CPM_CR_FCC2_PAGE;
> > +			fs_enet_data.cp_block = CPM_CR_FCC2_SBLOCK;
> > +			break;
> > +		case fsid_fcc3:
> > +			fs_enet_data.mem_offset = FCC3_MEM_OFFSET,
> > +			snprintf((char*)&bus_id[4], BUS_ID_SIZE,
> > "%x:%02x", (u32) res.start, fs_enet_data.phy_addr);
> > +			fs_enet_data.bus_id = (char*)&bus_id[4];
> > +			fs_enet_data.cp_page = CPM_CR_FCC3_PAGE;
> > +			fs_enet_data.cp_block = CPM_CR_FCC3_SBLOCK;
> > +			break;
> > +		}
> 
> this looks like a lot of effort to just encode a single integer (1,  
> 2, 3) and then lookup the other information based on it.
> 

Not sure I am following what is suggested here. Could it be elaborated
a little bit ? 

> > +
> > +		if (strstr(model, "FCC")) {
> > +			fs_enet_data.dpram_offset =
> > (u32)cpm2_immr->im_dprambase;
> > +			fs_enet_data.rx_ring = 32;
> > +			fs_enet_data.tx_ring = 32;
> > +			fs_enet_data.rx_copybreak = 240;
> > +			fs_enet_data.use_napi = 0;
> > +			fs_enet_data.napi_weight = 17;
> > +		}
> > +
> > +		of_node_put(phy);
> > +		of_node_put(mdio);
> > +
> > +		ret = platform_device_add_data(fs_enet_dev,
> > &fs_enet_data,
> > +					     sizeof(struct
> > +
> > fs_platform_info));
> > +		if (ret)
> > +			goto unreg;
> > +	}
> > +	return 0;
> > +
> > +unreg:
> > +	platform_device_unregister(fs_enet_dev);
> > +err:
> > +	return ret;
> > +}
> > +
> > +arch_initcall(fs_enet_of_init);
> > +
> > +static const char *scc_regs = "regs";
> > +static const char *scc_pram = "pram";
> > +
> > +static int __init cpm_uart_of_init(void)
> > +{
> > +	struct device_node *np;
> > +	unsigned int i;
> > +	struct platform_device *cpm_uart_dev;
> > +	int ret;
> > +
> > +
> > +	for (np = NULL, i = 0;
> > +	     (np = of_find_compatible_node(np, "serial",
> > "cpm_uart")) != NULL;
> > +	     i++) {
> > +		struct resource r[3];
> > +		struct fs_uart_platform_info cpm_uart_data;
> > +		int *id;
> > +
> > +		memset(r, 0, sizeof(r));
> > +		memset(&cpm_uart_data, 0, sizeof(cpm_uart_data));
> > +
> > +		ret = of_address_to_resource(np, 0, &r[0]);
> > +		if (ret)
> > +			goto err;
> > +
> > +		r[0].name = scc_regs;
> > +
> > +		ret = of_address_to_resource(np, 1, &r[1]);
> > +		if (ret)
> > +			goto err;
> > +		r[1].name = scc_pram;
> > +
> > +		r[2].start = np->intrs[0].line;
> > +		r[2].end = np->intrs[0].line;
> > +		r[2].flags = IORESOURCE_IRQ;
> > +
> > +		cpm_uart_dev =
> > +
> > platform_device_register_simple("fsl-cpm-scc:uart", i, &r [0], 3);
> > +
> > +		if (IS_ERR(cpm_uart_dev)) {
> > +			ret = PTR_ERR(cpm_uart_dev);
> > +			goto err;
> > +		}
> > +
> > +		id = get_property(np, "device-id", NULL);
> > +		cpm_uart_data.fs_no = *id;
> > +		cpm_uart_data.uart_clk = get_intfreq();
> > +
> > +		cpm_uart_data.tx_num_fifo = 4;
> > +		cpm_uart_data.tx_buf_size = 32;
> > +		cpm_uart_data.rx_num_fifo = 4;
> > +		cpm_uart_data.rx_buf_size = 32;
> > +
> > +		ret =
> > +		    platform_device_add_data(cpm_uart_dev,
> > &cpm_uart_data,
> > +					     sizeof(struct
> > +
> > fs_uart_platform_info));
> > +		if (ret)
> > +			goto unreg;
> > +	}
> > +
> > +	return 0;
> > +
> > +unreg:
> > +	platform_device_unregister(cpm_uart_dev);
> > +err:
> > +	return ret;
> > +}
> > +
> > +arch_initcall(cpm_uart_of_init);
> > diff --git a/include/asm-ppc/cpm2.h b/include/asm-ppc/cpm2.h
> > index f6a7ff0..8e6840b 100644
> > --- a/include/asm-ppc/cpm2.h
> > +++ b/include/asm-ppc/cpm2.h
> > @@ -1186,7 +1186,7 @@ #define PC3_DIRC1	(PC3_TXDAT)
> >  #define FCC_MEM_OFFSET(x) (CPM_FCC_SPECIAL_BASE + (x*128))
> >  #define FCC1_MEM_OFFSET FCC_MEM_OFFSET(0)
> >  #define FCC2_MEM_OFFSET FCC_MEM_OFFSET(1)
> > -#define FCC2_MEM_OFFSET FCC_MEM_OFFSET(2)
> > +#define FCC3_MEM_OFFSET FCC_MEM_OFFSET(2)
> >
> >  #endif /* __CPM2__ */
> >  #endif /* __KERNEL__ */
> > _______________________________________________
> > Linuxppc-dev mailing list
> > Linuxppc-dev at ozlabs.org
> > https://ozlabs.org/mailman/listinfo/linuxppc-dev
> 
> 



More information about the Linuxppc-dev mailing list