This patch simplifies the driver by making use of more common code.

Tested on Freescale MPC8349emitxgp eval board
Signed-off-by: NGrant Likely <grant.likely@secretlab.ca>
Acked-by: NAndy Fleming <afleming@freescale.com>
Signed-off-by: NDavid S. Miller <davem@davemloft.net>