comb5015 var 0.21 dspic part

Fix wrong math for Tad calculate.