Improve Speed and avoid useless delay + Add Intensive Test Function + Introduce More Warnings in Mplab Compiler