HULK: welcome aboard
Take a look at the last code, it works fine with my Arduino, I'm very happy it works!!
I'll take a look at your code too, and if you want to contribute something, do it
EDIT: take a look at another thread saying "OBDuino working"