Based on original patch by Chris Dearman <chris@mips.com>.
Signed-off-by: NRalf Baechle <ralf@linux-mips.org>