Wiimote Project

I've created my own project based on this DesktopVR program, and I have a problem/question. My program involves 3D models, and as you move left/right, the model rotates left/right accordingly. When you move back/forward, the model zooms out/in. Now, here's where the problem is; when you move left/right, the model moves smoothly left and right. However, when you step back/forward, the models "jitters", or zooms in/out rapidly back and forth. It gets worse the further you back away from the Wiimote.

I use a simple distance formula between the two IR LEDs to determine how far you are from the Wiimote. Is there a better algorithm that would allow zooming in/out to be smoother? Does the "jittering" problem have anything to do with the matrix math (doubt it)? Does using a 3D model instead of 2D vectors/pics (like in the DesktopVR demo) promote the problem?

Thanks, that definitely smoothed it out a lot. However, it's still doing it just a little bit, enough for it to be noticeable. Is there any other way to smooth it out even more? I've tried rounding the distance between the two IR points to four or five decimal points, but that didn't do much of anything at all.

It's still also slightly worse the further you move away from the Wiimote. Does the Wiimote just suck the further you are from it?

I don't think I'll be able to release all the code, but there's a small chance I will.