Merge remote-tracking branch 'github/3.0-vybrid-lineo' into 3.0-vybrid

Conflicts:
	arch/arm/mach-mvf/board-twr_vf600.c

7 files changed, 290 insertions, 282 deletions

diff --git a/drivers/char/ftimer.c b/drivers/char/ftimer.c
index 88a31997ef8f..9fe19fa70475 100644
--- a/drivers/char/ftimer.c
+++ b/drivers/char/ftimer.c
@@ -311,7 +311,7 @@ int ftm_probe(struct platform_device *pdev)
 	struct resource *ftm_membase, *ftm_irq;
 	struct mvf_ftm_dev *timedevptr;
 
-	ftm_membase = platform_get_resource(pdev, IORESOURCE_MEM, 1);
+	ftm_membase = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 	ftm_irq = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
 
 	if (!ftm_irq || !ftm_membase){
@@ -353,6 +353,7 @@ int ftm_probe(struct platform_device *pdev)
 	platform_set_drvdata(pdev, timedevptr);
 
 	timer_master_register_platform(pdev);
+	printk (KERN_INFO "Flex Timer Module Driver (id = %d) Installed.\n", pdev->id);
 
 	return 0;
 }
diff --git a/drivers/char/lptimer.c b/drivers/char/lptimer.c
index 3203580beda1..d955cbd4c7fb 100644
--- a/drivers/char/lptimer.c
+++ b/drivers/char/lptimer.c
@@ -112,7 +112,7 @@ int lpt_enable_timer( int timer_handle)
 	//	must not be altered.
 	val = readl(membase + LPTMR_CSR_OFFSET);
 	val |= ( LPTMR_CSR_TEN|LPTMR_CSR_TIE);
-	writel( val, membase + LPTMR_CSR_TEN);
+	writel( val, membase + LPTMR_CSR_OFFSET);
 
  	return 0;
 }
@@ -142,7 +142,7 @@ int lpt_disable_timer( int timer_handle)
 	//	including the CNR and TCF.
 	val = readl(membase + LPTMR_CSR_OFFSET);
 	val &= ~LPTMR_CSR_TEN;
-	writel( val, membase + LPTMR_CSR_TEN);
+	writel( val, membase + LPTMR_CSR_OFFSET);
 
 	return  0;
 }
@@ -175,6 +175,9 @@ int lpt_read_counter( int timer_handle, unsigned long *counter)
 	pdev = timer_master_get_pdev(timer_handle);
 	timedevptr = platform_get_drvdata(pdev);
 
+	//	Synchronize temporary reg
+	writel( 0, timedevptr->membase + LPTMR_CNR_OFFSET);
+
 	//	16bit timer
 	*counter = readl( timedevptr->membase + LPTMR_CNR_OFFSET) & 0x0000ffff;
 
@@ -251,6 +254,11 @@ int lpt_param_set( int timer_handle, struct mvf_lpt_request *req, void (*event_h
 
 	//	compare
 	writel( req->compare_value, membase + LPTMR_CMR_OFFSET);
+#if 0
+printk("register LPTMR_CSR_OFFSET %x\n", readl( timedevptr->membase + LPTMR_CSR_OFFSET));
+printk("register LPTMR_PSR_OFFSET %x\n", readl( timedevptr->membase + LPTMR_PSR_OFFSET));
+printk("register LPTMR_CMR_OFFSET %x\n", readl( timedevptr->membase + LPTMR_CMR_OFFSET));
+#endif
 
 	timedevptr->event_handler = event_handler;
 	timedevptr->configured++;
@@ -272,7 +280,7 @@ int lpt_probe(struct platform_device *pdev)
 	struct resource *lptmr_membase, *lptmr_irq;
 	struct mvf_lpt_dev *timedevptr;
 
-	lptmr_membase = platform_get_resource(pdev, IORESOURCE_MEM, 1);
+	lptmr_membase = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 	lptmr_irq = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
 
 	if (!lptmr_irq || !lptmr_membase){
@@ -310,6 +318,8 @@ int lpt_probe(struct platform_device *pdev)
 
 	timer_master_register_platform(pdev);
 
+	printk (KERN_INFO "Low Power Timer Driver Installed.\n");
+
 	return 0;
 }
 
diff --git a/drivers/char/mvf_timer_master.c b/drivers/char/mvf_timer_master.c
index 56d134d499be..4bf245feed54 100644
--- a/drivers/char/mvf_timer_master.c
+++ b/drivers/char/mvf_timer_master.c
@@ -88,6 +88,7 @@ static int timer_master_alloc_timer( int index)
 			if ( master_control.is_opened[ i] == TIMER_AVAILABLE){
 				master_control.is_opened[ i] = TIMER_BUSY;
 				ret = i;
+				break;
 			}
 		}
 	}else
diff --git a/drivers/char/pitimer.c b/drivers/char/pitimer.c
index b83da781e76c..2b81732d4aa5 100644
--- a/drivers/char/pitimer.c
+++ b/drivers/char/pitimer.c
@@ -115,7 +115,13 @@ int pit_enable_timer( int timer_handle)
 
 	membase = timedevptr->membase;
 
-	writel( PIT_TFLG_TIF, timedevptr->membase + PIT_TFLG_OFFSET( i));
+//	writel( PIT_TFLG_TIF, timedevptr->membase + PIT_TFLG_OFFSET( i));
+
+	//	enable timer Int
+	val =  PIT_TCTR_TIE;
+	writel( val, membase + PIT_TCTRL_OFFSET( i));
+
+	//	enable timer 
 	val = PIT_TCTR_TEN | PIT_TCTR_TIE;
 	writel( val, membase + PIT_TCTRL_OFFSET( i));
 
@@ -195,7 +201,6 @@ int pit_param_set( int timer_handle, unsigned long load_val, void (*event_handle
 	struct platform_device *pdev;
 	struct mvf_pit_dev *timedevptr;
 	
-
 	if ( !timer_master_is_opened( timer_handle)){
 		return -EAGAIN;
 	}
@@ -227,12 +232,12 @@ int pit_probe(struct platform_device *pdev)
 {
 	int size;
 	int result;
-	int i;
+	int i, init_start;
 	unsigned long val;
 	struct resource *pit_membase, *pit_irq;
 	struct mvf_pit_dev *timedevptr;
 
-	pit_membase = platform_get_resource(pdev, IORESOURCE_MEM, 1);
+	pit_membase = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 	pit_irq = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
 
 	if (!pit_irq || !pit_membase){
@@ -278,10 +283,26 @@ int pit_probe(struct platform_device *pdev)
 		//	timer clock start
 		writel( 0, timedevptr->membase + PIT_MCR_OFFSET);
 	}else{
-		//	assume PIT 0 is kernel system tick
+#ifdef CONFIG_MVF_USE_PIT
 		pit_alloc_timer( PIT0);
-		printk(KERN_WARNING"Maybe PIT0 is system tick\n");
+		printk(KERN_WARNING"PIT0 is system tick.\n");
+#endif
+	}
+
+	//	init timer
+#ifdef CONFIG_MVF_USE_PIT
+	//	init from pit1
+	init_start = 1;
+#else
+	//	init from pit0
+	init_start = 0;
+#endif
+
+	for ( i = init_start; i < TIMER_MASTER_MAX_TIMER; i ++){
+		writel( 0, timedevptr->membase + PIT_TCTRL_OFFSET( i));
+
 	}
+	printk (KERN_INFO "Periodic Timer Driver Installed.\n");
 
 	return 0;
 }
@@ -293,7 +314,7 @@ static int __devexit pit_remove(struct platform_device *pdev)
 	timedevptr = platform_get_drvdata(pdev);
 
 	//	disable all
-	pit_disable_timer( 0);
+//	pit_disable_timer( 0);
 	clk_disable( timedevptr->clk);
 	kfree( timedevptr);
 
diff --git a/drivers/dma/mvf_edma.c b/drivers/dma/mvf_edma.c
index e04e45af74c1..cf934174b558 100644
--- a/drivers/dma/mvf_edma.c
+++ b/drivers/dma/mvf_edma.c
@@ -29,6 +29,8 @@
 #include <asm/mvf_edma.h>
 #include <asm/mvf_edma_regs.h>
 
+//#define SCATTER_TEST
+
 #define MVF_MODE_MEMCPY	0x01
 #define MVF_MODE_CYCLIC	0x02
 #define MVF_MODE_SC		0x03
@@ -68,6 +70,20 @@ struct mvf_dma_engine {
 	int				err_irq[MVF_MAX_DMA_ENGINE];
 };
 
+void mvf_dma_regdump( void __iomem *base, int channel)
+{
+	printk("REG ADDR=%x  REG%x\n", (unsigned int)&MVF_EDMA_TCD_SADDR(base, channel),	(unsigned int)MVF_EDMA_TCD_SADDR(base, channel));
+	printk("REG ADDR=%x  REG%x\n", (unsigned int)&MVF_EDMA_TCD_DADDR(base, channel),	(unsigned int)MVF_EDMA_TCD_DADDR(base, channel));
+	printk("REG ADDR=%x  REG%x\n", (unsigned int)&MVF_EDMA_TCD_ATTR(base, channel), 	(unsigned int)MVF_EDMA_TCD_ATTR(base, channel));
+	printk("REG ADDR=%x  REG%x\n", (unsigned int)&MVF_EDMA_TCD_SOFF(base, channel),		(unsigned int)MVF_EDMA_TCD_SOFF(base, channel));
+	printk("REG ADDR=%x  REG%x\n", (unsigned int)&MVF_EDMA_TCD_NBYTES(base, channel),	(unsigned int)MVF_EDMA_TCD_NBYTES(base, channel));
+	printk("REG ADDR=%x  REG%x\n", (unsigned int)&MVF_EDMA_TCD_SLAST(base, channel),	(unsigned int)MVF_EDMA_TCD_SLAST(base, channel));
+	printk("REG ADDR=%x  REG%x\n", (unsigned int)&MVF_EDMA_TCD_CITER(base, channel),	(unsigned int)MVF_EDMA_TCD_CITER(base, channel));
+	printk("REG ADDR=%x  REG%x\n", (unsigned int)&MVF_EDMA_TCD_BITER(base, channel),	(unsigned int)MVF_EDMA_TCD_BITER(base, channel));
+	printk("REG ADDR=%x  REG%x\n", (unsigned int)&MVF_EDMA_TCD_DOFF(base, channel),		(unsigned int)MVF_EDMA_TCD_DOFF(base, channel));
+	printk("REG ADDR=%x  REG%x\n", (unsigned int)&MVF_EDMA_TCD_DLAST_SGA(base, channel),(unsigned int)MVF_EDMA_TCD_DLAST_SGA(base, channel));
+	printk("REG ADDR=%x  REG%x\n", (unsigned int)&MVF_EDMA_TCD_CSR(base, channel),		(unsigned int)MVF_EDMA_TCD_CSR(base, channel));
+}
 
 static void mvf_dma_reset_chan(struct mvf_dma_chan *mvf_chan)
 {
@@ -169,18 +185,18 @@ static int mvf_dma_sg_next(struct mvf_dma_chan *mvf_chan, struct scatterlist *sg
 		if ( mvf_chan->word_size == DMA_SLAVE_BUSWIDTH_1_BYTE){
 			srcflag = MVF_EDMA_TCD_ATTR_SSIZE_8BIT;
 			dstflag = MVF_EDMA_TCD_ATTR_DSIZE_8BIT;
-			srcdelta = 0;
+			srcdelta = 1;
 			dstdelta = 1;
 		}else
 		if ( mvf_chan->word_size == DMA_SLAVE_BUSWIDTH_2_BYTES){
 			srcflag = MVF_EDMA_TCD_ATTR_SSIZE_16BIT;
 			dstflag = MVF_EDMA_TCD_ATTR_DSIZE_16BIT;
-			srcdelta = 0;
+			srcdelta = 2;
 			dstdelta = 2;
 		}else{
 			srcflag = MVF_EDMA_TCD_ATTR_SSIZE_32BIT;
 			dstflag = MVF_EDMA_TCD_ATTR_DSIZE_32BIT;
-			srcdelta = 0;
+			srcdelta = 4;
 			dstdelta = 4;
 		}
 
@@ -217,6 +233,12 @@ static int mvf_dma_sg_next(struct mvf_dma_chan *mvf_chan, struct scatterlist *sg
 	MVF_EDMA_TCD_BITER(base, channel) = MVF_EDMA_TCD_BITER_BITER(1);
 	MVF_EDMA_TCD_DLAST_SGA(base, channel) = MVF_EDMA_TCD_DLAST_SGA_DLAST_SGA(0);
 
+//	mvf_dma_regdump(base, channel);
+
+	MVF_EDMA_TCD_CSR(base,channel) |= MVF_EDMA_TCD_CSR_INT_MAJOR;
+	MVF_EDMA_TCD_CSR(base,channel) &= ~MVF_EDMA_TCD_CSR_D_REQ;
+	MVF_EDMA_SEEI(base) = MVF_EDMA_SEEI_SEEI(channel);
+
 	return now;
 }
 
@@ -253,14 +275,19 @@ static int mvf_dma_handle(struct mvf_dma_chan *mvf_chan)
 		if (mvf_chan->sg_list) {
 			current_sg = mvf_chan->sg_list;
 			mvf_chan->sg_list = sg_next(mvf_chan->sg_list);
-			
 			// prepare next transfer
 			if (mvf_chan->sg_list) {
+#ifdef SCATTER_TEST
+			if ( mvf_chan->sg_list->length != 0){
+#endif
 				//	re-fill tx parameter
 				mvf_dma_sg_next(mvf_chan, mvf_chan->sg_list);
 				//	start tx
 				mvf_dma_enable_chan(mvf_chan);
 				ret = 1;
+#ifdef SCATTER_TEST
+			}
+#endif
 			}
 		}
 	}
@@ -290,10 +317,10 @@ static irqreturn_t mvf_dma_int_handler(int irq, void *dev_id)
 		printk("error irq\n");
 		return IRQ_HANDLED;
 	}
+	//printk("DMA irq occured = CR:%x  ES:%x SRC:%x \n", MVF_EDMA_CR(base), MVF_EDMA_ES(base),MVF_EDMA_INT(base));
 
 	//	read int source and clear soon
 	int_src = MVF_EDMA_INT(base);
-	MVF_EDMA_CINT(base) = MVF_EDMA_CINT_CAIR;
 
 	//	deliver int source and re-enable (if scatter gather is configured)
 	for (i = 0; i < MVF_EACH_DMA_CHANNEL; i++) {
@@ -310,6 +337,7 @@ static irqreturn_t mvf_dma_int_handler(int irq, void *dev_id)
 					tasklet_schedule(&mvf_chan->tasklet);
 				}
 			}
+			MVF_EDMA_CINT(base) = i;
 		}
 	}
 
@@ -331,10 +359,11 @@ static irqreturn_t mvf_dma_err_handler(int irq, void *dev_id)
 			engine = i;
 		}
 	}
+	printk(KERN_INFO"DMA error irq occured = CR:%x  ES:%x\n", (unsigned int)MVF_EDMA_CR(base), (unsigned int)MVF_EDMA_ES(base));
 
 	//	fail safe
 	if (!base){
-		printk("error irq\n");
+		printk(KERN_INFO"error irq\n");
 		return IRQ_HANDLED;
 	}
 
@@ -343,6 +372,7 @@ static irqreturn_t mvf_dma_err_handler(int irq, void *dev_id)
 		if ( err & (1 << i)){
 			mvf_chan = mvf_find_chan(mvf_dma, engine, i);
 			if (mvf_chan){
+				mvf_chan->last_completed = mvf_chan->desc.cookie;
 				mvf_chan->status = DMA_ERROR;
 				tasklet_schedule(&mvf_chan->tasklet);
 			}
@@ -357,14 +387,13 @@ static irqreturn_t mvf_dma_err_handler(int irq, void *dev_id)
 static int mvf_dma_alloc_chan_resources(struct dma_chan *chan)
 {
 	struct mvf_dma_chan *mvf_chan = to_mvf_dma_chan(chan);
-//	struct mvf_dma_engine *mvf_dma = mvf_chan->mvf_dma;
 
 	mvf_dma_reset_chan(mvf_chan);
 
 	dma_async_tx_descriptor_init(&mvf_chan->desc, chan);
 	mvf_chan->desc.tx_submit = mvf_dma_tx_submit;
 
-	/* the descriptor is ready */
+	//	the descriptor is ready
 	async_tx_ack(&mvf_chan->desc);
 
 	return 0;
@@ -373,11 +402,8 @@ static int mvf_dma_alloc_chan_resources(struct dma_chan *chan)
 static void mvf_dma_free_chan_resources(struct dma_chan *chan)
 {
 	struct mvf_dma_chan *mvf_chan = to_mvf_dma_chan(chan);
-//	struct mvf_dma_engine *mvf_dma = mvf_chan->mvf_dma;
 
 	mvf_dma_disable_chan(mvf_chan);
-
-//	free_irq(mvf_chan->chan_irq, mvf_dma);
 }
 
 
@@ -387,12 +413,9 @@ mvf_edma_set_tcd_params(struct mvf_dma_chan *mvf_chan, u32 source, u32 dest,
 			u32 citer, u32 biter, u32 doff, u32 dlast_sga,
 			int major_int, int disable_req)
 {
-//	struct mvf_dma_chan *mvf_chan = to_mvf_dma_chan(chan);
-//	struct mvf_dma_engine *mvf_dma = mvf_chan->mvf_dma;
-
 	int channel = mvf_chan->chan.chan_id % MVF_EACH_DMA_CHANNEL;
 	void __iomem *base = mvf_chan->chan_mem_base;
-	
+
 	MVF_EDMA_TCD_SADDR(base, channel) = source;
 	MVF_EDMA_TCD_DADDR(base, channel) = dest;
 	MVF_EDMA_TCD_ATTR(base, channel) = attr;
@@ -404,6 +427,21 @@ mvf_edma_set_tcd_params(struct mvf_dma_chan *mvf_chan, u32 source, u32 dest,
 	MVF_EDMA_TCD_DOFF(base, channel) = MVF_EDMA_TCD_DOFF_DOFF(doff);
 	MVF_EDMA_TCD_DLAST_SGA(base, channel) = MVF_EDMA_TCD_DLAST_SGA_DLAST_SGA(dlast_sga);
 
+#if 0
+	printk("Channel:%d  Top reg:%x\n TX descriptor  src : %x / dest : %x / attr : %x\n",channel, &MVF_EDMA_TCD_SADDR(base, channel), source,dest,attr);
+	MVF_EDMA_TCD_SADDR(base, channel) = source&0xfffffff0;
+	MVF_EDMA_TCD_DADDR(base, channel) = dest&0xffffff00;
+	MVF_EDMA_TCD_ATTR(base, channel) = (0 | MVF_EDMA_TCD_ATTR_SSIZE_32BIT | MVF_EDMA_TCD_ATTR_DSIZE_32BIT);
+	MVF_EDMA_TCD_SOFF(base, channel) = 0x4;
+	MVF_EDMA_TCD_NBYTES(base, channel) = 16;
+	MVF_EDMA_TCD_SLAST(base, channel) = 0;
+	MVF_EDMA_TCD_CITER(base, channel) = 1;
+	MVF_EDMA_TCD_BITER(base, channel) = 1;
+	MVF_EDMA_TCD_DOFF(base, channel) = 4;
+	MVF_EDMA_TCD_DLAST_SGA(base, channel) = 0;
+	MVF_EDMA_TCD_CSR(base, channel) = 0x0000;
+#endif
+
 	/* interrupt at the end of major loop */
 	if (major_int)
 		MVF_EDMA_TCD_CSR(base,channel) |= MVF_EDMA_TCD_CSR_INT_MAJOR;
@@ -487,12 +525,8 @@ static struct dma_async_tx_descriptor *mvf_prep_slave_sg(
 	}
 	mvf_chan->sg_list = sgl;
 
-#if 1
 	ret = mvf_dma_setup_sg(mvf_chan, sg_len, dma_length, dmamode);
-#else
-	ret = imx_dma_setup_sg(imxdmac->imxdma_channel, sgl, sg_len,
-		 dma_length, imxdmac->per_address, dmamode);
-#endif
+
 	if (ret)
 		return NULL;
 
@@ -514,20 +548,12 @@ static struct dma_async_tx_descriptor *mvf_dma_prep_dma_cyclic(
 	mvf_chan->status = DMA_IN_PROGRESS;
 	mvf_chan->flags = MVF_MODE_CYCLIC;
 
-#if 0
-	ret = imx_dma_setup_progression_handler(imxdmac->imxdma_channel,
-			imxdma_progression);
-	if (ret) {
-		dev_err(imxdma->dev, "Failed to setup the DMA handler\n");
-		return NULL;
-	}
-#endif
-
 	if (mvf_chan->sg_list)
 		kfree(mvf_chan->sg_list);
 
 	mvf_chan->sg_list = kcalloc(periods + 1,
 			sizeof(struct scatterlist), GFP_KERNEL);
+
 	if (!mvf_chan->sg_list)
 		return NULL;
 
@@ -542,10 +568,12 @@ static struct dma_async_tx_descriptor *mvf_dma_prep_dma_cyclic(
 	}
 
 	/* close the loop */
+#ifndef SCATTER_TEST
 	mvf_chan->sg_list[periods].offset = 0;
 	mvf_chan->sg_list[periods].length = 0;
 	mvf_chan->sg_list[periods].page_link =
 		((unsigned long)mvf_chan->sg_list | 0x01) & ~0x02;
+#endif
 
 	if (direction == DMA_DEV_TO_MEM)
 		dmamode = DMA_MODE_READ;
@@ -573,33 +601,14 @@ static struct dma_async_tx_descriptor *mvf_dma_prep_memcpy
 	mvf_chan->flags = MVF_MODE_MEMCPY;
 	mvf_chan->status = DMA_IN_PROGRESS;
 
-	//	chan_id
-#if 1
 	mvf_edma_set_tcd_params(
 						mvf_chan,
 						src,
 						dst,
-						(0 | MVF_EDMA_TCD_ATTR_SSIZE_32BIT | MVF_EDMA_TCD_ATTR_DSIZE_32BIT), 
-						0x04,
-						len, 0x0, 1, 1, 
-						0x04, 0x0, 0x1,0x0);
-
-#else
-	//	channel control
-	if ( channel == 10){
-		mvf_edma_set_tcd_params(
-						channel,
-						src,
-						dst,
-						(0 | MVF_EDMA_TCD_ATTR_SSIZE_32BIT | MVF_EDMA_TCD_ATTR_DSIZE_32BIT), 
-						0x04,
+						(0 | MVF_EDMA_TCD_ATTR_SSIZE_8BIT | MVF_EDMA_TCD_ATTR_DSIZE_8BIT), 
+						0x01,
 						len, 0x0, 1, 1, 
-						0x04, 0x0, 0x1,0x0);
-	}else{
-	}
-#endif
-
-
+						0x01, 0x0, 0x1,0x0);
 	mvf_chan->desc_count = 0;
 
 	return &mvf_chan->desc;
@@ -689,22 +698,6 @@ static int __init mvf_dma_init(struct mvf_dma_engine *mvf_dma)
 
 	}
 	return 0;
-
-
-#if 0
-	int ret;
-
-	ret = clk_prepare_enable(mvf_dma->clk);
-	if (ret)
-		return ret;
-
-	ret = mxs_reset_block(mvf_dma->base);
-	if (ret)
-		goto err_out;
-
-err_out:
-	return ret;
-#endif
 }
 
 static int __init mvf_dma_probe(struct platform_device *pdev)
@@ -727,7 +720,7 @@ static int __init mvf_dma_probe(struct platform_device *pdev)
 		}
 
 		mvf_dma->base[i] = ioremap(iores->start, resource_size(iores));
-		if (!mvf_dma->base) {
+		if (!mvf_dma->base[i]) {
 			ret = -ENOMEM;
 			goto err_ioremap;
 		}
@@ -744,14 +737,6 @@ static int __init mvf_dma_probe(struct platform_device *pdev)
 		mvf_dma->err_irq[i]=errirq_res->start;
 	}
 
-#if 0
-	mvf_dma->clk = clk_get(&pdev->dev, NULL);
-	if (IS_ERR(mvf_dma->clk)) {
-		ret = PTR_ERR(mvf_dma->clk);
-		goto err_clk;
-	}
-#endif
-
 	dma_cap_set(DMA_MEMCPY, mvf_dma->dma_device.cap_mask);
 	dma_cap_set(DMA_SLAVE, mvf_dma->dma_device.cap_mask);
 	dma_cap_set(DMA_CYCLIC, mvf_dma->dma_device.cap_mask);
@@ -761,7 +746,6 @@ static int __init mvf_dma_probe(struct platform_device *pdev)
 	/* Initialize channel parameters */
 	for (i = 0; i < MVF_EDMA_CHANNELS; i++) {
 		struct mvf_dma_chan *mvf_chan = &mvf_dma->mvf_chans[i];
-
 		index =  i / MVF_EACH_DMA_CHANNEL;
 
 		mvf_chan->mvf_dma = mvf_dma;
@@ -771,7 +755,6 @@ static int __init mvf_dma_probe(struct platform_device *pdev)
 		tasklet_init(&mvf_chan->tasklet, mvf_dma_tasklet,
 			     (unsigned long) mvf_chan);
 
-
 		/* Add the channel to mvf_chan list */
 		list_add_tail(&mvf_chan->chan.device_node,
 			&mvf_dma->dma_device.channels);
@@ -802,7 +785,7 @@ static int __init mvf_dma_probe(struct platform_device *pdev)
 		goto err_init;
 	}
 
-	dev_info(mvf_dma->dma_device.dev, "initialized\n");
+	printk(KERN_INFO "eDMA driver Installed.\n");
 
 	return 0;
 
diff --git a/drivers/net/mvf_switch.c b/drivers/net/mvf_switch.c
index b2a943756aa5..3c5ece8f78f7 100644
--- a/drivers/net/mvf_switch.c
+++ b/drivers/net/mvf_switch.c
@@ -39,6 +39,7 @@
 #include <linux/uaccess.h>
 #include <linux/io.h>
 #include <linux/signal.h>
+#include <linux/clk.h>
 
 #include <asm/irq.h>
 #include <asm/pgtable.h>
@@ -49,6 +50,8 @@
 #include <asm/mvf_switch.h>
 #include "mvf_switch.h"
 
+#define LOOKUP_ELEMENTS 2048
+
 #define	SWITCH_MAX_PORTS	1
 #define CONFIG_FEC_SHARED_PHY
 #define FEC_PHY
@@ -58,6 +61,8 @@
 #define CONFIG_ENHANCED_BD
 #endif
 
+#define TOMOICHI_DMA_MOVE
+
 /* Interrupt events/masks.
 */
 #define FEC_ENET_HBERR	((uint)0x80000000)	/* Heartbeat error */
@@ -71,6 +76,16 @@
 #define FEC_ENET_MII	((uint)0x00800000)	/* MII interrupt */
 #define FEC_ENET_EBERR	((uint)0x00400000)	/* SDMA bus error */
 
+#define FEC_MMFR_ST			(1 << 30)
+#define FEC_MMFR_OP_READ	(2 << 28)
+#define FEC_MMFR_OP_WRITE	(1 << 28)
+#define FEC_MMFR_PA(v)		((v & 0x1f) << 23)
+#define FEC_MMFR_RA(v)		((v & 0x1f) << 18)
+#define FEC_MMFR_TA			(2 << 16)
+#define FEC_MMFR_DATA(v)	(v & 0xffff)
+#define FEC_MII_TIMEOUT		30 /* ms */
+
+
 static int switch_enet_open(struct net_device *dev);
 static int switch_enet_start_xmit(struct sk_buff *skb, struct net_device *dev);
 static irqreturn_t switch_enet_interrupt(int irq, void *dev_id);
@@ -87,8 +102,7 @@ static void switch_set_mac_address(struct net_device *dev);
 /* Make MII read/write commands for the FEC.
 */
 #define mk_mii_read(REG)	(0x60020000 | ((REG & 0x1f) << 18))
-#define mk_mii_write(REG, VAL)	(0x50020000 | ((REG & 0x1f) << 18) | \
-						(VAL & 0xffff))
+#define mk_mii_write(REG, VAL)	(0x50020000 | ((REG & 0x1f) << 18) | (VAL & 0xffff))
 
 /* Transmitter timeout.
 */
@@ -102,6 +116,30 @@ struct port_status ports_link_status;
 /* the user space pid, used to send the link change to user space */
 long user_pid = 1;
 
+//	for debug
+void dump_regs(void __iomem *fec)
+{
+	printk("FEC_ECNTRL REG = %x\n", readl(fec + FEC_ECNTRL));
+	printk("FEC_MII_SPEED REG = %x\n", readl(fec + FEC_MII_SPEED));
+	printk("FEC_R_CNTRL REG = %x\n", readl(fec + FEC_R_CNTRL));
+	printk("FEC_X_CNTRL REG = %x\n", readl(fec + FEC_X_CNTRL));
+}
+
+static void adjust_phy_speed( struct switch_enet_private *fep, int phy_index)
+{
+	u32 val;
+
+	val = readl(fep->fec[phy_index] + FEC_R_CNTRL);
+	if (fep->phydev[phy_index] && fep->phydev[phy_index]->speed == SPEED_100){
+		printk("Phy %d is 100M\n", phy_index);
+		val &= ~(1 << 9);
+	}else{
+		printk("Phy %d is 10M\n", phy_index);
+		val |= (1 << 9);
+	}
+	writel(val, fep->fec[phy_index] + FEC_R_CNTRL);
+}
+
 /* ----------------------------------------------------------------*/
 /*
  * Calculate Galois Field Arithmetic CRC for Polynom x^8+x^2+x+1.
@@ -156,7 +194,6 @@ void read_atable(struct switch_enet_private *fep,
 	int index,
 	unsigned long *read_lo, unsigned long *read_hi)
 {
-//	unsigned long atable_base = 0xFC0E0000;
 	unsigned long atable_base = (long)fep->hwentry;
 
 	*read_lo = *((volatile unsigned long *)(atable_base + (index<<3)));
@@ -167,7 +204,6 @@ void write_atable(struct switch_enet_private *fep,
 	int index,
 	unsigned long write_lo, unsigned long write_hi)
 {
-//	unsigned long atable_base = 0xFC0E0000;
 	unsigned long atable_base = (long)fep->hwentry;
 
 	*((volatile unsigned long *)(atable_base + (index<<3))) = write_lo;
@@ -241,7 +277,7 @@ eswPortInfo *esw_portinfofifo_read(
 void esw_clear_atable(struct switch_enet_private *fep)
 {
 	int index;
-	for (index = 0; index < 2048; index++)
+	for (index = 0; index < LOOKUP_ELEMENTS; index++)
 		write_atable(fep, index, 0, 0);
 }
 
@@ -249,7 +285,7 @@ void esw_dump_atable(struct switch_enet_private *fep)
 {
 	int index;
 	unsigned long read_lo, read_hi;
-	for (index = 0; index < 2048; index++) {
+	for (index = 0; index < LOOKUP_ELEMENTS; index++) {
 		read_atable(fep, index, &read_lo, &read_hi);
 	}
 
@@ -1077,11 +1113,11 @@ void esw_mac_lookup_table_range(struct switch_enet_private *fep)
 	int index;
 	unsigned long read_lo, read_hi;
 	/* Pointer to switch address look up memory*/
-	for (index = 0; index < 2048; index++)
+	for (index = 0; index < LOOKUP_ELEMENTS; index++)
 		write_atable(fep, index, index, (~index));
 
 	/* Pointer to switch address look up memory*/
-	for (index = 0; index < 2048; index++) {
+	for (index = 0; index < LOOKUP_ELEMENTS; index++) {
 		read_atable(fep, index, &read_lo, &read_hi);
 		if (read_lo != index) {
 			printk(KERN_ERR "%s:Mismatch at low %d\n",
@@ -2321,6 +2357,7 @@ int esw_get_mac_address_lookup_table(struct switch_enet_private *fep,
 static void l2switch_aging_timer(unsigned long data)
 {
 	struct switch_enet_private *fep;
+printk("aging occured\n");
 
 	fep = (struct switch_enet_private *)data;
 
@@ -3203,6 +3240,9 @@ switch_enet_start_xmit(struct sk_buff *skb, struct net_device *dev)
 	cbd_t	*bdp;
 	unsigned short	status;
 	unsigned long flags;
+#ifdef TOMOICHI_DMA_MOVE
+	void *bufaddr;
+#endif
 
 	fep = netdev_priv(dev);
 	fecp = (switch_t *)fep->hwp;
@@ -3219,7 +3259,11 @@ switch_enet_start_xmit(struct sk_buff *skb, struct net_device *dev)
 
 	/* Set buffer length and buffer pointer.
 	*/
+#ifdef TOMOICHI_DMA_MOVE
+	bufaddr = skb->data;
+#else
 	bdp->cbd_bufaddr = __pa(skb->data);
+#endif
 	bdp->cbd_datlen = skb->len;
 
 	/*
@@ -3233,7 +3277,11 @@ switch_enet_start_xmit(struct sk_buff *skb, struct net_device *dev)
 
 		memcpy(fep->tx_bounce[index1],
 		       (void *)skb->data, bdp->cbd_datlen);
+#ifdef TOMOICHI_DMA_MOVE
+		bufaddr = fep->tx_bounce[index1];
+#else
 		bdp->cbd_bufaddr = __pa(fep->tx_bounce[index1]);
+#endif
 	}
 
 	/* Save skb pointer. */
@@ -3246,8 +3294,13 @@ switch_enet_start_xmit(struct sk_buff *skb, struct net_device *dev)
 	 * data.
 	 */
 //	flush_dcache_range((unsigned long)skb->data,
+#ifdef TOMOICHI_DMA_MOVE
+	bdp->cbd_bufaddr = dma_map_single(&fep->pdev->dev, bufaddr,
+			SWITCH_ENET_TX_FRSIZE, DMA_TO_DEVICE);
+#else
 	flush_kernel_vmap_range(skb->data,
 			   (unsigned long)skb->data + skb->len);
+#endif
 
 	/* Send it on its way.  Tell FEC it's ready, interrupt when done,
 	 * it's the last BD of the frame, and to put the CRC on the end.
@@ -3304,12 +3357,14 @@ switch_enet_interrupt(int irq, void *dev_id)
 	irqreturn_t ret = IRQ_NONE;
 
 	fecp = (switch_t *)dev->base_addr;
-
 	/* Get the interrupt events that caused us to be here.
 	*/
 	do {
 		int_events = fecp->switch_ievent;
 		fecp->switch_ievent = int_events;
+
+//		if (int_events)printk("Interrupt %s:%d occured ev:%x, reg address %x\n",  __func__, __LINE__,int_events, &fecp->switch_ievent);
+
 		/* Handle receive event in its own function. */
 
 		/* Transmit OK, or non-fatal error. Update the buffer
@@ -3361,7 +3416,12 @@ switch_enet_tx(struct net_device *dev)
 	while (((status = bdp->cbd_sc) & BD_ENET_TX_READY) == 0) {
 		if (bdp == fep->cur_tx && fep->tx_full == 0)
 			break;
-
+#ifdef TOMOICHI_DMA_MOVE
+		if (bdp->cbd_bufaddr)
+			dma_unmap_single(&fep->pdev->dev, bdp->cbd_bufaddr,
+				SWITCH_ENET_TX_FRSIZE, DMA_TO_DEVICE);
+		bdp->cbd_bufaddr = 0;
+#endif
 		skb = fep->tx_skbuff[fep->skb_dirty];
 		/* Check for errors. */
 		if (status & (BD_ENET_TX_HB | BD_ENET_TX_LC |
@@ -3483,6 +3543,7 @@ switch_enet_rx(struct net_device *dev)
 		dev->stats.rx_bytes += pkt_len;
 		data = (__u8 *)__va(bdp->cbd_bufaddr);
 
+
 		/* This does 16 byte alignment, exactly what we need.
 		 * The packet length includes FCS, but we don't want to
 		 * include that when passing upstream as it messes up
@@ -3498,6 +3559,7 @@ switch_enet_rx(struct net_device *dev)
 			skb->protocol = eth_type_trans(skb, dev);
 			netif_rx(skb);
 		}
+
 rx_processing_done:
 
 		/* Clear the status flags for this buffer */
@@ -3524,70 +3586,45 @@ rx_processing_done:
 	spin_unlock_irq(&fep->hw_lock);
 }
 
-static int fec_mdio_transfer(struct mii_bus *bus, int phy_id,
-	int reg, int regval)
+static int mvf_fec_mdio_read(struct mii_bus *bus,
+	int phy_id, int reg)
 {
-	struct net_device *dev = bus->priv;
-	unsigned long   flags;
+	unsigned long time_left;
 	struct switch_enet_private *fep;
-	int tries = 100;
-	int retval = 0;
 
-	fep = netdev_priv(dev);
-	spin_lock_irqsave(&fep->mii_lock, flags);
-
-	regval |= phy_id << 23;
-#if 0
-	MCF_FEC_MMFR0 = regval;
-#else
-	writel(regval, fep->fec[0] + FEC_MII_DATA);
-#endif
-
-	/* wait for it to finish, this takes about 23 us on lite5200b */
-#if 0
-	while (!(MCF_FEC_EIR0 & FEC_ENET_MII) && --tries)
-#else
-	while (!(readl(fep->fec[0]+FEC_IEVENT) & FEC_ENET_MII) && --tries)
-#endif
-		udelay(5);
-
-	if (!tries) {
-		printk(KERN_ERR "%s timeout\n", __func__);
-		return -ETIMEDOUT;
-	}
-
-#if 0
-	MCF_FEC_EIR0 = FEC_ENET_MII;
-#else
-	writel(FEC_ENET_MII, fep->fec[0]+FEC_IEVENT);
-#endif
-
-#if 0
-	retval = MCF_FEC_MMFR0;
-#else
-	retval = readl(fep->fec[0] + FEC_MII_DATA);
-#endif
+	struct net_device *dev = bus->priv;
 
-	spin_unlock_irqrestore(&fep->mii_lock, flags);
+	fep = netdev_priv(dev);
 
-	return retval;
-}
+	/* start a read op */
+	writel(FEC_MMFR_ST | FEC_MMFR_OP_READ |
+		FEC_MMFR_PA(phy_id) | FEC_MMFR_RA(reg) |
+		FEC_MMFR_TA, fep->fec[0] + FEC_MII_DATA);
 
+	mdelay(FEC_MII_TIMEOUT);
 
-static int mvf_fec_mdio_read(struct mii_bus *bus,
-	int phy_id, int reg)
-{
-	int ret;
-	ret = fec_mdio_transfer(bus, phy_id, reg,
-		mk_mii_read(reg));
-	return ret;
+	/* return value */
+	return FEC_MMFR_DATA(readl(fep->fec[0] + FEC_MII_DATA));
 }
 
 static int mvf_fec_mdio_write(struct mii_bus *bus,
 	int phy_id, int reg, u16 data)
 {
-	return fec_mdio_transfer(bus, phy_id, reg,
-			mk_mii_write(reg, data));
+	unsigned long time_left;
+	struct switch_enet_private *fep;
+	struct net_device *dev = bus->priv;
+
+	fep = netdev_priv(dev);
+
+	/* start a write op */
+	writel(FEC_MMFR_ST | FEC_MMFR_OP_WRITE |
+		FEC_MMFR_PA(phy_id) | FEC_MMFR_RA(reg) |
+		FEC_MMFR_TA | FEC_MMFR_DATA(data),
+		fep->fec[0] + FEC_MII_DATA);
+
+	mdelay(FEC_MII_TIMEOUT);
+
+	return 0;
 }
 
 static void switch_adjust_link1(struct net_device *dev)
@@ -3605,6 +3642,7 @@ static void switch_adjust_link1(struct net_device *dev)
 		if (phydev1->speed != priv->phy1_speed) {
 			new_state = 1;
 			priv->phy1_speed = phydev1->speed;
+			adjust_phy_speed(priv,0);
 		}
 
 		if (priv->phy1_old_link == PHY_DOWN) {
@@ -3626,6 +3664,10 @@ static void switch_adjust_link1(struct net_device *dev)
 		/*Send the new status to user space*/
 		if (user_pid != 1)
 			sys_tkill(user_pid, SIGUSR1);
+
+#if 1
+		phy_print_status(phydev1);
+#endif
 	}
 }
 
@@ -3644,6 +3686,7 @@ static void switch_adjust_link2(struct net_device *dev)
 		if (phydev2->speed != priv->phy2_speed) {
 			new_state = 1;
 			priv->phy2_speed = phydev2->speed;
+			adjust_phy_speed(priv,1);
 		}
 
 		if (priv->phy2_old_link == PHY_DOWN) {
@@ -3665,13 +3708,17 @@ static void switch_adjust_link2(struct net_device *dev)
 		/*Send the new status to user space*/
 		if (user_pid != 1)
 			sys_tkill(user_pid, SIGUSR1);
+
+#if 1
+		phy_print_status(phydev2);
+#endif
 	}
 }
 
 static int mvf_switch_init_phy(struct net_device *dev)
 {
 	struct switch_enet_private *priv = netdev_priv(dev);
-	struct phy_device *phydev[SWITCH_EPORT_NUMBER] = {NULL, NULL};
+	struct phy_device *phydev[PHY_MAX_ADDR] = {NULL, NULL};
 	int i, startnode = 0;
 
 	/* search for connect PHY device */
@@ -3722,34 +3769,24 @@ static int mvf_switch_init_phy(struct net_device *dev)
 	priv->phy2_speed = 0;
 	priv->phy2_duplex = -1;
 
-#ifndef CONFIG_ARCH_MVF
-	phydev[0] = phy_connect(dev, phydev[0]->dev.bus_id,
-#else
 	phydev[0] = phy_connect(dev, dev_name(&phydev[0]->dev),
-#endif
 		&switch_adjust_link1, 0, PHY_INTERFACE_MODE_MII);
 	if (IS_ERR(phydev[0])) {
 		printk(KERN_ERR " %s phy_connect failed\n", __func__);
 		return PTR_ERR(phydev[0]);
 	}
-
-#ifndef CONFIG_ARCH_MVF
-	phydev[1] = phy_connect(dev, phydev[1]->dev.bus_id,
-#else
-	phydev[0] = phy_connect(dev, dev_name(&phydev[0]->dev),
-#endif
+	phydev[1] = phy_connect(dev, dev_name(&phydev[1]->dev),
 		&switch_adjust_link2, 0, PHY_INTERFACE_MODE_MII);
 	if (IS_ERR(phydev[1])) {
 		printk(KERN_ERR " %s phy_connect failed\n", __func__);
 		return PTR_ERR(phydev[1]);
 	}
-
+	printk("Phy devs %s, %s\n", dev_name(&phydev[0]->dev),dev_name(&phydev[1]->dev));
 	for (i = 0; i < SWITCH_EPORT_NUMBER; i++) {
 		printk(KERN_INFO "attached phy %i to driver %s\n",
 			phydev[i]->addr, phydev[i]->drv->name);
 		priv->phydev[i] = phydev[i];
 	}
-
 	return 0;
 }
 /* -----------------------------------------------------------------------*/
@@ -3760,6 +3797,7 @@ switch_enet_open(struct net_device *dev)
 	volatile switch_t *fecp;
 	int i;
 
+
 	fecp = (volatile switch_t *)fep->hwp;
 	/* I should reset the ring buffers here, but I don't yet know
 	 * a simple way to do that.
@@ -3783,7 +3821,6 @@ switch_enet_open(struct net_device *dev)
 
 	/* no phy,  go full duplex,  it's most likely a hub chip */
 	switch_restart(dev, 1);
-
 	/* if the fec is the fist open, we need to do nothing*/
 	/* if the fec is not the fist open, we need to restart the FEC*/
 	if (fep->sequence_done == 0)
@@ -3800,6 +3837,8 @@ switch_enet_open(struct net_device *dev)
 
 	netif_start_queue(dev);
 	fep->opened = 1;
+
+
 	return 0;
 }
 
@@ -3809,6 +3848,7 @@ switch_enet_close(struct net_device *dev)
 	struct switch_enet_private *fep = netdev_priv(dev);
 	int i;
 
+
 	/* Don't know what to do yet.*/
 	fep->opened = 0;
 	netif_stop_queue(dev);
@@ -3820,6 +3860,8 @@ switch_enet_close(struct net_device *dev)
 		phy_write(fep->phydev[i], MII_BMCR, BMCR_PDOWN);
 	}
 #endif
+
+
 	return 0;
 }
 
@@ -3897,78 +3939,57 @@ switch_set_mac_address(struct net_device *dev)
 static void
 switch_hw_init(	struct switch_enet_private *fep)
 {
-#if 0
-	/* GPIO config - RMII mode for both MACs */
-	MCF_GPIO_PAR_FEC = (MCF_GPIO_PAR_FEC &
-		MCF_GPIO_PAR_FEC_FEC_MASK) |
-		MCF_GPIO_PAR_FEC_FEC_RMII0FUL_1FUL;
-#endif
-
+	int i;
 
-#if 0
-	/* Initialize MAC 0/1 */
-	/* RCR */
-	MCF_FEC_RCR0 = (MCF_FEC_RCR_PROM | MCF_FEC_RCR_RMII_MODE |
-			MCF_FEC_RCR_MAX_FL(1522) | MCF_FEC_RCR_CRC_FWD);
-	MCF_FEC_RCR1 = (MCF_FEC_RCR_PROM | MCF_FEC_RCR_RMII_MODE |
-			MCF_FEC_RCR_MAX_FL(1522) | MCF_FEC_RCR_CRC_FWD);
-	/* TCR */
-	MCF_FEC_TCR0 = MCF_FEC_TCR_FDEN;
-	MCF_FEC_TCR1 = MCF_FEC_TCR_FDEN;
-#else
+//	/* Initialize MAC 0/1 */
+//	/* RCR */
+//	MCF_FEC_RCR0 = (MCF_FEC_RCR_PROM | MCF_FEC_RCR_RMII_MODE |
+//			MCF_FEC_RCR_MAX_FL(1522) | MCF_FEC_RCR_CRC_FWD);
+//	MCF_FEC_RCR1 = (MCF_FEC_RCR_PROM | MCF_FEC_RCR_RMII_MODE |
+//			MCF_FEC_RCR_MAX_FL(1522) | MCF_FEC_RCR_CRC_FWD);
+//	/* TCR */
+//	MCF_FEC_TCR0 = MCF_FEC_TCR_FDEN;
+//	MCF_FEC_TCR1 = MCF_FEC_TCR_FDEN;
 	writel((MCF_FEC_RCR_PROM | MCF_FEC_RCR_RMII_MODE | MCF_FEC_RCR_MAX_FL(1522) | MCF_FEC_RCR_CRC_FWD), fep->fec[0] + FEC_R_CNTRL);
 	writel((MCF_FEC_RCR_PROM | MCF_FEC_RCR_RMII_MODE | MCF_FEC_RCR_MAX_FL(1522) | MCF_FEC_RCR_CRC_FWD), fep->fec[1] + FEC_R_CNTRL);
 
 	writel(MCF_FEC_TCR_FDEN, fep->fec[0] + FEC_X_CNTRL);
 	writel(MCF_FEC_TCR_FDEN, fep->fec[1] + FEC_X_CNTRL);
-#endif
-
 
-
-#if 0
 	/* ECR */
-#ifdef CONFIG_ENHANCED_BD
-	MCF_FEC_ECR0 = MCF_FEC_ECR_ETHER_EN | MCF_FEC_ECR_ENA_1588;
-	MCF_FEC_ECR1 = MCF_FEC_ECR_ETHER_EN | MCF_FEC_ECR_ENA_1588;
-#else
-	MCF_FEC_ECR0 = MCF_FEC_ECR_ETHER_EN;
-	MCF_FEC_ECR1 = MCF_FEC_ECR_ETHER_EN;
-#endif
-
-#else
-
+// #ifdef CONFIG_ENHANCED_BD
+//	MCF_FEC_ECR0 = MCF_FEC_ECR_ETHER_EN | MCF_FEC_ECR_ENA_1588;
+//	MCF_FEC_ECR1 = MCF_FEC_ECR_ETHER_EN | MCF_FEC_ECR_ENA_1588;
+//#else
+//	MCF_FEC_ECR0 = MCF_FEC_ECR_ETHER_EN;
+//	MCF_FEC_ECR1 = MCF_FEC_ECR_ETHER_EN;
+//#endif
 
 #ifdef CONFIG_ENHANCED_BD
-	writel(MCF_FEC_ECR_ETHER_EN | MCF_FEC_ECR_ENA_1588, fep->fec[0] + FEC_ECNTRL);
-	writel(MCF_FEC_ECR_ETHER_EN | MCF_FEC_ECR_ENA_1588, fep->fec[1] + FEC_ECNTRL);
+	writel(MCF_FEC_ECR_ETHER_EN | MCF_FEC_ECR_ENA_1588 |MCF_FEC_ECR_SWAP, fep->fec[0] + FEC_ECNTRL);
+	writel(MCF_FEC_ECR_ETHER_EN | MCF_FEC_ECR_ENA_1588 |MCF_FEC_ECR_SWAP, fep->fec[1] + FEC_ECNTRL);
 #else
-	writel(MCF_FEC_ECR_ETHER_EN , fep->fec[0] + FEC_ECNTRL);
-	writel(MCF_FEC_ECR_ETHER_EN , fep->fec[1] + FEC_ECNTRL);
+	writel(MCF_FEC_ECR_ETHER_EN |MCF_FEC_ECR_SWAP, fep->fec[0] + FEC_ECNTRL);
+	writel(MCF_FEC_ECR_ETHER_EN |MCF_FEC_ECR_SWAP, fep->fec[1] + FEC_ECNTRL);
 #endif
 
-#endif
 
 
-#if 0
-	MCF_FEC_MSCR0 = ((((MCF_CLK / 2) / (2500000 / 10)) + 5) / 10) * 2;
-	MCF_FEC_MSCR1 = ((((MCF_CLK / 2) / (2500000 / 10)) + 5) / 10) * 2;
+//	MCF_FEC_MSCR0 = ((((MCF_CLK / 2) / (2500000 / 10)) + 5) / 10) * 2;
+//	MCF_FEC_MSCR1 = ((((MCF_CLK / 2) / (2500000 / 10)) + 5) / 10) * 2;
 
-	MCF_FEC_EIMR0 = FEC_ENET_TXF | FEC_ENET_RXF;
-	MCF_FEC_EIMR1 = FEC_ENET_TXF | FEC_ENET_RXF;
+//	MCF_FEC_EIMR0 = FEC_ENET_TXF | FEC_ENET_RXF;
+//	MCF_FEC_EIMR1 = FEC_ENET_TXF | FEC_ENET_RXF;
 	/*MCF_PPMHR0*/
-	MCF_PPMCR0 = 0;
-#else
+//	MCF_PPMCR0 = 0;
 	writel( MVF_MII_SWITCH_SPEED, fep->fec[0] + FEC_MII_SPEED);
 	writel( MVF_MII_SWITCH_SPEED, fep->fec[1] + FEC_MII_SPEED);
 	writel( FEC_ENET_TXF | FEC_ENET_RXF, fep->fec[0] + FEC_IMASK);
 	writel( FEC_ENET_TXF | FEC_ENET_RXF, fep->fec[1] + FEC_IMASK);
 
-//	MCF_PPMCR0 = 0;
-//	writel( , fep->fec[0] + );
-	#pragma message "need fix!!!!!"
-#endif
-
-
+	for (i = 0; i < SWITCH_EPORT_NUMBER; i++) {
+		adjust_phy_speed(fep, i);
+	}
 }
 
 #ifdef CONFIG_ARCH_MVF
@@ -4006,7 +4027,11 @@ int __init switch_enet_init(struct net_device *dev,
 
 	/* Allocate memory for buffer descriptors.
 	*/
+//#ifdef TOMOICHI_DMA_MOVE
+//	mem_addr = dma_alloc_coherent(NULL, PAGE_SIZE, &fep->bd_dma, GFP_KERNEL);
+//#else
 	mem_addr = __get_free_page(GFP_DMA);
+//#endif
 	if (mem_addr == 0) {
 		printk(KERN_ERR "Switch: allocate descriptor memory failed?\n");
 		return -ENOMEM;
@@ -4026,7 +4051,7 @@ int __init switch_enet_init(struct net_device *dev,
 	fep->index = slot;
 	fep->hwp = fecp;
 #ifdef CONFIG_ARCH_MVF
-	fep->hwentry =  (eswAddrTable_t *)ioremap(plat->switch_hw[1], SZ_4K);
+	fep->hwentry =  (eswAddrTable_t *)ioremap(plat->switch_hw[1], SZ_16K);
 #else
 	fep->hwentry = (eswAddrTable_t *)plat->switch_hw[1];
 #endif
@@ -4108,6 +4133,7 @@ int __init switch_enet_init(struct net_device *dev,
 		for (j = 0; j < SWITCH_ENET_RX_FRPPG; j++) {
 			bdp->cbd_sc = BD_ENET_RX_EMPTY;
 			bdp->cbd_bufaddr = __pa(mem_addr);
+
 #ifdef CONFIG_ENHANCED_BD
 			bdp->bdu = 0x00000000;
 			bdp->ebd_status = RX_BD_INT;
@@ -4185,6 +4211,7 @@ int __init switch_enet_init(struct net_device *dev,
 	fecp->switch_imask  = MCF_ESW_IMR_RXB | MCF_ESW_IMR_TXB |
 		MCF_ESW_IMR_RXF | MCF_ESW_IMR_TXF;
 	esw_clear_atable(fep);
+
 	/* Queue up command to detect the PHY and initialize the
 	 * remainder of the interface.
 	 */
@@ -4214,14 +4241,10 @@ switch_restart(struct net_device *dev, int duplex)
 	fep = netdev_priv(dev);
 	fecp = fep->hwp;
 	plat = fep->pdev->dev.platform_data;
+
 	/* Whack a reset.  We should wait for this.*/
-#if 0
-	MCF_FEC_ECR0 = 1;
-	MCF_FEC_ECR1 = 1;
-#else
 	writel(1, fep->fec[0] + FEC_ECNTRL);
 	writel(1, fep->fec[1] + FEC_ECNTRL);
-#endif
 
 	udelay(10);
 
@@ -4343,6 +4366,11 @@ switch_stop(struct net_device *dev)
 	udelay(10);
 }
 
+static int mvf_fec_mdio_reset(struct mii_bus *bus)
+{
+	return 0;
+}
+
 static int fec_mdio_register(struct net_device *dev,
 	int slot)
 {
@@ -4366,8 +4394,9 @@ static int fec_mdio_register(struct net_device *dev,
 			"support more than 2 mii bus\n");
 	}
 
-	fep->mdio_bus->read = &mvf_fec_mdio_read;
-	fep->mdio_bus->write = &mvf_fec_mdio_write;
+	fep->mdio_bus->read = mvf_fec_mdio_read;
+	fep->mdio_bus->write = mvf_fec_mdio_write;
+	fep->mdio_bus->reset = mvf_fec_mdio_reset;
 	fep->mdio_bus->priv = dev;
 	err = mdiobus_register(fep->mdio_bus);
 	if (err) {
@@ -4387,7 +4416,6 @@ static int __init eth_switch_probe(struct platform_device *pdev)
 	struct net_device *dev;
 	int i, err;
 	struct switch_enet_private *fep;
-
 	struct switch_platform_private *chip;
 	struct task_struct *task;
 
@@ -4401,6 +4429,23 @@ static int __init eth_switch_probe(struct platform_device *pdev)
 			(unsigned int)chip);
 		return err;
 	}
+	chip->fec0 = clk_get(&pdev->dev, "fec_clk");
+	chip->fec1 = clk_get(&pdev->dev, "fec1_clk");
+	chip->l2sw = clk_get(&pdev->dev, "eth_l2_sw_clk");
+
+	if ( IS_ERR( chip->fec0 )) {
+		dev_err(&pdev->dev, "Could not get FEC0 clock \n");
+		return PTR_ERR( chip->fec0);
+	}
+	if ( IS_ERR( chip->fec1 )) {
+		dev_err(&pdev->dev, "Could not get FEC1 clock \n");
+		return PTR_ERR( chip->fec1);
+	}
+	if ( IS_ERR( chip->l2sw )) {
+		dev_err(&pdev->dev, "Could not get L2 Switch clock \n");
+		return PTR_ERR( chip->l2sw);
+	}
+
 
 	chip->pdev = pdev;
 	chip->num_slots = SWITCH_MAX_PORTS;
@@ -4449,6 +4494,7 @@ static int __init eth_switch_probe(struct platform_device *pdev)
 			return -ENOMEM;
 		}
 #endif
+
 		/* setup timer for Learning Aging function */
 		init_timer(&fep->timer_aging);
 		fep->timer_aging.function = l2switch_aging_timer;
@@ -4499,6 +4545,9 @@ static int eth_switch_remove(struct platform_device *pdev)
 
 			del_timer_sync(&fep->timer_aging);
 		}
+		clk_disable( chip->fec0);
+		clk_disable( chip->fec1);
+		clk_disable( chip->l2sw);
 
 		platform_set_drvdata(pdev, NULL);
 		kfree(chip);
diff --git a/drivers/net/mvf_switch.h b/drivers/net/mvf_switch.h
index 7e40414836d5..5fbf1a4e1665 100644
--- a/drivers/net/mvf_switch.h
+++ b/drivers/net/mvf_switch.h
@@ -62,63 +62,6 @@
 #error "L2SWITCH: descriptor ring size constants too large"
 #endif
 
-/*unsigned long MCF_ESW_LOOKUP_MEM;*/
-#if 0
-#define MCF_ESW_REVISION   (*(volatile unsigned long *)(0xFC0DC000))
-#define MCF_ESW_PER        (*(volatile unsigned long *)(0xFC0DC008))
-#define MCF_ESW_VLANV      (*(volatile unsigned long *)(0xFC0DC010))
-#define MCF_ESW_DBCR       (*(volatile unsigned long *)(0xFC0DC014))
-#define MCF_ESW_DMCR       (*(volatile unsigned long *)(0xFC0DC018))
-#define MCF_ESW_BKLR       (*(volatile unsigned long *)(0xFC0DC01C))
-#define MCF_ESW_BMPC       (*(volatile unsigned long *)(0xFC0DC020))
-#define MCF_ESW_MODE       (*(volatile unsigned long *)(0xFC0DC024))
-
-#define MCF_ESW_ISR        (*(volatile unsigned long *)(0xFC0DC400))
-#define MCF_ESW_IMR        (*(volatile unsigned long *)(0xFC0DC404))
-#define MCF_ESW_TDAR       (*(volatile unsigned long *)(0xFC0DC418))
-#define MCF_ESW_LOOKUP_MEM (*(volatile unsigned long *)(0xFC0E0000))
-
-#define MCF_PPMCR0   (*(volatile unsigned short *)(0xFC04002D))
-#define MCF_PPMHR0   (*(volatile unsigned long *)(0xFC040030))
-#endif
-
-#if 0
-//	for compile
-#define MCF_FEC_EIR0       (*(volatile unsigned long *)(0xFC0D4004))
-#define MCF_FEC_EIR1       (*(volatile unsigned long *)(0xFC0D8004))
-#define MCF_FEC_EIMR0      (*(volatile unsigned long *)(0xFC0D4008))
-#define MCF_FEC_EIMR1      (*(volatile unsigned long *)(0xFC0D8008))
-#define MCF_FEC_MMFR0      (*(volatile unsigned long *)(0xFC0D4040))
-#define MCF_FEC_MMFR1      (*(volatile unsigned long *)(0xFC0D8040))
-#define MCF_FEC_MSCR0      (*(volatile unsigned long *)(0xFC0D4044))
-#define MCF_FEC_MSCR1      (*(volatile unsigned long *)(0xFC0D8044))
-#define MCF_FEC_RCR0       (*(volatile unsigned long *)(0xFC0D4084))
-#define MCF_FEC_RCR1       (*(volatile unsigned long *)(0xFC0D8084))
-#define MCF_FEC_TCR0       (*(volatile unsigned long *)(0xFC0D40C4))
-#define MCF_FEC_TCR1       (*(volatile unsigned long *)(0xFC0D80C4))
-#define MCF_FEC_ECR0       (*(volatile unsigned long *)(0xFC0D4024))
-#define MCF_FEC_ECR1       (*(volatile unsigned long *)(0xFC0D8024))
-#else
-//	from fec.h
-//	#define FEC_R_CNTRL		0x084 /* Receive control reg */
-//	#define FEC_X_CNTRL		0x0c4 /* Transmit Control reg */
-//	#define FEC_IEVENT		0x004 /* Interrupt event reg */
-//	#define FEC_IMASK		0x008 
-//	#define FEC_MII_DATA		0x040 /* MII manage frame reg */
-//	#define FEC_MII_SPEED		0x044 /* MII speed control reg */
-//	#define FEC_ECNTRL		0x024 /* Ethernet control reg */
-
-#endif
-
-#define MCF_FEC_RCR_PROM                (0x00000008)
-#define MCF_FEC_RCR_RMII_MODE           (0x00000100)
-#define MCF_FEC_RCR_MAX_FL(x)           (((x)&0x00003FFF)<<16)
-#define MCF_FEC_RCR_CRC_FWD             (0x00004000)
-#define MCF_FEC_TCR_FDEN                (0x00000004)
-#define MCF_FEC_ECR_ETHER_EN            (0x00000002)
-#define MCF_FEC_ECR_ENA_1588            (0x00000010)
-
-
 /*=============================================================*/
 #define LEARNING_AGING_TIMER (10 * HZ)