This patch just moves code around and polishes it. Also, compile in only
selected pieces of hardware.
Signed-off-by: NMarek Vasut <marek.vasut@gmail.com>
Signed-off-by: NEric Miao <eric.y.miao@gmail.com>