Ah.. I forgot the division operation. It is just division operation for D3 format you can write like below. For instance:

before:
D3DXVec4Divide(vec,vec.w);
after:
//D3DXVec4Divide(vec,vec.w);
vec.x /=vec.w;
vec.y /=vec.w;
vec.z /=vec.w;

Tried it. Was very slow if I compare it with the one that comes with GS.
My machine is very slow I know, but the one from GS works, not perfectly but much better.
But thank you for uploading it here, I appreciate it.