2000 GMC Jimmy 4x4
NV246 4-button

Things I've done:
-Replaced Vaccum Lines
-Replaced Vaccum Solenoid
-Replaced encoder motor on TC
-Replaced switch on front axle
-Checked contacts on TCCM, appear clean
-Checked Vacuum actuator and cable

I've attempted to read other posts and figure this thing out but I've hit a dead end. When I start my truck it constantly flashes in 4Hi but won't shift out into 2Hi or Auto4x4. It just blinks and then goes back to a flashing 4Hi and then I'll get the Service 4x4 light. Occasionally I can get it into 4Lo and I can feel that it is engaged but I can't shift out of 4Lo and then I'll get the Service 4x4 light again.
I had the codes pulled when the service light came on and I got:
C0222 - Front Right wheel speed sensor
C0387 - Unable to shift

Not sure if a wheel speed senor can affect this or if it's something else. Need a little help on where to go next. Thanks!