More PS/2 changes

PS/2 changes and some test bench verification