Index: kernel/arch/arm32/Makefile.inc
===================================================================
--- kernel/arch/arm32/Makefile.inc	(revision 3412e8449ffca52d5d7d869c12d18218b51f38e9)
+++ kernel/arch/arm32/Makefile.inc	(revision e80d8f80769540a1b89ed77cf77e774ce257c705)
@@ -37,5 +37,6 @@
 ifeq ($(CONFIG_FPU),y)
 # This is necessary to allow vmsr insn and fpexc manipulation
-GCC_CFLAGS += -mfloat-abi=hard 
+# Use vfp32 to allow context save/restore of d16-d31 regs.
+GCC_CFLAGS += -mfloat-abi=hard -mfpu=vfp3
 endif
 
@@ -51,4 +52,5 @@
 	arch/$(KARCH)/src/machine_func.c \
 	arch/$(KARCH)/src/context.S \
+	arch/$(KARCH)/src/fpu_context.c \
 	arch/$(KARCH)/src/dummy.S \
 	arch/$(KARCH)/src/cpu/cpu.c \