Idea and implementation courtesy of Kim Phillips <kim.phillips@freescale.com> Signed-off-by: Wolfgang Denk <wd@denx.de>