This function currently outputs twice as much data as it should and
overwrites its buffer as a result. Fix it.
Signed-off-by: NSimon Glass <sjg@chromium.org>