$A = ($a*($p1-$p2) + $b*($pT-$p1)/(-2));
$B = ($p1*($a*($p2-$p1) + $b*($pT-$p1)-$k*$d2-$d1i*$k));