goto clean_runtime_disable_ret;
        }
 
-       cpsw->txch[0] = cpdma_chan_create(cpsw->dma, tx_chan_num(0),
-                                         cpsw_tx_handler);
-       cpsw->rxch[0] = cpdma_chan_create(cpsw->dma, rx_chan_num(0),
-                                         cpsw_rx_handler);
-
+       cpsw->txch[0] = cpdma_chan_create(cpsw->dma, 0, cpsw_tx_handler, 0);
+       cpsw->rxch[0] = cpdma_chan_create(cpsw->dma, 0, cpsw_rx_handler, 1);
        if (WARN_ON(!cpsw->rxch[0] || !cpsw->txch[0])) {
                dev_err(priv->dev, "error initializing dma channels\n");
                ret = -ENOMEM;
 
        int     int_set, int_clear, td;
 };
 
+#define tx_chan_num(chan)      (chan)
+#define rx_chan_num(chan)      ((chan) + CPDMA_MAX_CHANNELS)
+#define is_rx_chan(chan)       ((chan)->chan_num >= CPDMA_MAX_CHANNELS)
+#define is_tx_chan(chan)       (!is_rx_chan(chan))
+#define __chan_linear(chan_num)        ((chan_num) & (CPDMA_MAX_CHANNELS - 1))
+#define chan_linear(chan)      __chan_linear((chan)->chan_num)
+
 /* The following make access to common cpdma_ctlr params more readable */
 #define dmaregs                params.dmaregs
 #define num_chan       params.num_chan
 }
 
 struct cpdma_chan *cpdma_chan_create(struct cpdma_ctlr *ctlr, int chan_num,
-                                    cpdma_handler_fn handler)
+                                    cpdma_handler_fn handler, int rx_type)
 {
+       int offset = chan_num * 4;
        struct cpdma_chan *chan;
-       int offset = (chan_num % CPDMA_MAX_CHANNELS) * 4;
        unsigned long flags;
 
+       chan_num = rx_type ? rx_chan_num(chan_num) : tx_chan_num(chan_num);
+
        if (__chan_linear(chan_num) >= ctlr->num_chan)
                return NULL;
 
 
 
 #define CPDMA_MAX_CHANNELS     BITS_PER_LONG
 
-#define tx_chan_num(chan)      (chan)
-#define rx_chan_num(chan)      ((chan) + CPDMA_MAX_CHANNELS)
-#define is_rx_chan(chan)       ((chan)->chan_num >= CPDMA_MAX_CHANNELS)
-#define is_tx_chan(chan)       (!is_rx_chan(chan))
-#define __chan_linear(chan_num)        ((chan_num) & (CPDMA_MAX_CHANNELS - 1))
-#define chan_linear(chan)      __chan_linear((chan)->chan_num)
-
 #define CPDMA_RX_SOURCE_PORT(__status__)       ((__status__ >> 16) & 0x7)
 
 #define CPDMA_EOI_RX_THRESH    0x0
 int cpdma_ctlr_stop(struct cpdma_ctlr *ctlr);
 
 struct cpdma_chan *cpdma_chan_create(struct cpdma_ctlr *ctlr, int chan_num,
-                                    cpdma_handler_fn handler);
+                                    cpdma_handler_fn handler, int rx_type);
 int cpdma_chan_get_rx_buf_num(struct cpdma_chan *chan);
 int cpdma_chan_destroy(struct cpdma_chan *chan);
 int cpdma_chan_start(struct cpdma_chan *chan);
 
                goto no_pdata;
        }
 
-       priv->txchan = cpdma_chan_create(priv->dma, tx_chan_num(EMAC_DEF_TX_CH),
-                                      emac_tx_handler);
-       priv->rxchan = cpdma_chan_create(priv->dma, rx_chan_num(EMAC_DEF_RX_CH),
-                                      emac_rx_handler);
+       priv->txchan = cpdma_chan_create(priv->dma, EMAC_DEF_TX_CH,
+                                        emac_tx_handler, 0);
+       priv->rxchan = cpdma_chan_create(priv->dma, EMAC_DEF_RX_CH,
+                                        emac_rx_handler, 1);
        if (WARN_ON(!priv->txchan || !priv->rxchan)) {
                rc = -ENOMEM;
                goto no_cpdma_chan;