Try a shift kit before you go tearing that transmission out. Mine had similar behavior and the shift kit fixed it.

The rough idle in drive could be other issues such as a dirty throttle body or IAC, etc.