Update of Stage 2

Stage 2 Entry Point and CPU testing routines updated.