I am happy to help...But you didn't answer my questions
It seems like you are trying to use PID control of speed during teleop while simultaneously using a non-linear joystick curve. I understand why a non-linear joystick curve can help with a jumpy robot, but I do not understand why you want to do PID speed control.