vfp: optimize, credits to rox-

Change-Id: I2fafe63c6209296d0b81ea8db4dd9e7c0c03c804
Signed-off-by: zwliew <zhaoweiliew@gmail.com>