problem s kapacitou ?? (PHP)

function last_space($o, $p, $r, $s, $t, $u, $v)// args[A, B, x, d, diff_1, index, index]
{
      
      $matrix= array(array());// [0][i] - stredy // [1][i] - spojnice2 // [2][i] - vysky //
       for($i = 1, $j = 0 ; $j < floor($o / $s) ; $i+=2, $j++)
               {
               $matrix[0][$j] = $i * $r;
               }

            for($i = 1 ; $i < 5 ; $i++)
              {
              for($j = 0 ; $j < floor(count($matrix[0])) ; $j++)
               {
               $matrix[$i][$j]=0;// nulovanie zvysku - v tele fcie budu prepisane podla potreby
               }
              }


            $vertic       = ($p - $r) - ($s + (floor(($p - $s)/($s - $t)) - 1) * ($s - $t) - $r);
            $horizont = $s;
            

            $n = 1; $q = $m = $f = 0;   

      while($o - $f >= $r)
            {
               
               
               $spojnica       = sqrt($vertic * $vertic + $horizont * $horizont);
               $gamma          = rad2deg(acos(($s * $s + $s * $s - $spojnica * $spojnica) / (2 * $s * $s)));
               $alfa          = (180 - $gamma) / 2;
               $alfa_          = rad2deg(acos($vertic * $vertic + $spojnica * $spojnica - $horizont * $horizont)/(2*$spojnica*$vertic));
               $alfa__          = 90 - $alfa - $alfa_;
               $gamma_       = (180 - $alfa__) / 2;
               $acko          = sqrt($s * $s + $s * $s - (2 * $s * $s) * cos(deg2rad($alfa__)));
               $v_c          = $s * sin(deg2rad($alfa__));

               //$posun1        = sqrt(pow($acko,2) - pow($v_c,2));
                $spojnica2     = sqrt($s*$s + $s*$s - 2*$s*$s*cos(deg2rad(180 - 2*$alfa__)));
               
               if(2 * $r + $f + ($spojnica2 / 2) > $o)
                  {
                  break;
                  }
               else if(2 * $r + $f + $spojnica2 / 2 <= $o)
                  {
                  $matrix[3][$q] = $m + $spojnica2 / 2;
                  $matrix[2][$q] = $v_c + $r;
                  $f             = $matrix[3][$q];
                  
                     if(2 * $r + $f + $spojnica2 <= $o)
                        {
                        $matrix[1][$q] = $m + $spojnica2;
                        $m             = $matrix[1][$q];
                        $f             = $m;
                        }
                  }
                  
               while(!($f+$r >= $matrix[0][$n - 1] && $f+$r < $matrix[0][$n] && $n < count($matrix[0])))
                    {
                      $n++;
                     
                     if($f+$r >= $matrix[0][$n - 1] && $f+$r < $matrix[0][$n])
                       {
                        $horizont          = $matrix[0][$n] - $f;
                        
                       }
                     
                    }
                   
               $q++;
                }
   return $matrix[$u][$v];
   
}