Using two timer libraries that are interfering with each other

JohnWasser+1
and
Without spending too much time looking at your code, you need to read up on ISR and Math functions within the ISR. You need as little as possible going on while time is spent in the ISR.