$A = -0.5*$b*($pT-$p1);
 $B = $b*($pT-$p1)-$k*($d2-$d1i);