The O2 heater is worthless and I believe unnecessary.

The CPS error would be more worrisome if your engine run like crap all the time. This makes me believe that you have some other issue making the CPS give a wonky response at that particular rpm range instead of all the time.
What scanner are you using ISTA-d or a Foxwell?

Sent from my SM-A730F using Tapatalk

Edit: Transmission, vacuum issue making signals not plausible for shifting or possible fluid level issue (just a guess) off the top of my head.

__________________
"When the Team Chief said.... You're trapped in a hole with nothing but a goat and a slinky, what do you do? Stubby said, I'm not sure but it won't end well for the goat...." ~(Overheard) Last day, Phase 3, Q Course