[ARM PATCH] 2318/1: Enable access to ARMv6 VFP coprocessr

Patch from George G. Davis

Turn on ARMv6 VFP copressor, if present. According to the ARM1136 TRM,
setting CACR bits will be ignored if the coprocessor is not present. In
that case, this is change has no effect.

Signed-off-by: George G. Davis
Signed-off-by: Russell King

arch/arm/mm/proc-v6.S

@@ -201,6 +201,11 @@ __v6_setup:
 	mov	r10, #0x1f			@ domains 0, 1 = manager
 	mcr	p15, 0, r10, c3, c0, 0		@ load domain access register
 	mrc	p15, 0, r0, c1, c0, 0		@ read control register
+#ifdef CONFIG_VFP
+	mrc	p15, 0, r10, c1, c0, 2
+	orr	r10, r10, #(3 << 20)
+	mcr	p15, 0, r10, c1, c0, 2		@ Enable full access to VFP
+#endif
 	ldr	r10, cr1_clear			@ get mask for bits to clear
 	bic	r0, r0, r10			@ clear bits them
 	ldr	r10, cr1_set			@ get mask for bits to set