как написать правильно формулу для подсчета

class Calculator
{
    private $quantity;
    private $sum;
 
    public function __construct(
        $quantity = 3,
        $sum = 2000
    )
    {
        $this->quantity = $quantity;
        $this->sum = $sum;
    }
 
    public function calc(array $items): int
    {
        $discount = 0;
        $groupSum = 0;
        $groupCount = 0;
 
        // перебираем по 1 шт.
        foreach ($items as $item) {
            for ($i = 1; $i <= $item->getQuantity(); $i++) {
                $groupCount++;
                $groupSum += $item->getPrice();
 
                if ($groupCount >= $this->quantity) {
                    $discount += max(0,$groupSum - $this->sum);
                    $groupCount = 0;
                    $groupSum = 0;
                }
            }
        }
 
        return $discount;
    }
}

function discount(...$items): int
{
}
 
discount([3, 1000]) === 1000;
discount([5, 1000]) === 1000;
discount([6, 1000]) === 2000;
discount([2, 1000], [1, 2000]) === 2000;

//сначала создал новый массив где каждый товар 1 позиция в количестве 1 штуки, т.е. если у меня было 1 позиция в количестве 3 штук то теперь это будут три позиции по 1 штуке
//отсортировал по цене
array_multisort(array_map(function($row) {
    return $row['PRICE'];
}, $basket_1), SORT_ASC, $basket_1);    
 
//формируем количество троек
$total = floor($poschet / 3);
//устанавливаем лимиты
            $limS=2000*$total;
            $lim=3*$total;
//считаем сумму
            for ($i = 0; $i < $lim; $i++) {
                $poschetSum+=$basket_1[$i]['PRICE'];
            }
//если наша сумма больше лимита то разницу в скидку            
            if( intval($poschetSum)*1 > abs($limS)*1 ){
                $discount['VALUE']=( $poschetSum*1 - abs($limS)*1 );                
            }
//иначе неположена скидка так как сумма товаров меньше лимита и мы еще и доплатить должны