Solved the problem. No matter what I did with the TCP length or angle, the movement was still not behaving correctly. After digging further, I found the encoder had to be reset. J3 and J5 were off significantly. If you run into this problem, set each joint to zero degrees and make sure it is in the proper zero position.