Optimizations for VFP
Fix data loss when cpu is offline
Fix compiling warnings
Optimize VFP