// Copyright ©2017 The Gonum Authors. All rights reserved.
// Use of this source code is governed by a BSD-style
// license that can be found in the LICENSE file.

package testlapack

import (
	"fmt"
	"math/rand/v2"
	"testing"

	"gonum.org/v1/gonum/blas"
	"gonum.org/v1/gonum/blas/blas64"
	"gonum.org/v1/gonum/lapack"
)

type Dlaqpser interface {
	Dlapmter
	Dlaqps(m, n, offset, nb int, a []float64, lda int, jpvt []int, tau, vn1, vn2, auxv, f []float64, ldf int) (kb int)
}

func DlaqpsTest(t *testing.T, impl Dlaqpser) {
	const tol = 1e-14

	rnd := rand.New(rand.NewPCG(1, 1))
	for ti, test := range []struct {
		m, n, nb, offset int
	}{
		{m: 4, n: 3, nb: 2, offset: 0},
		{m: 4, n: 3, nb: 1, offset: 2},
		{m: 3, n: 4, nb: 2, offset: 0},
		{m: 3, n: 4, nb: 1, offset: 2},
		{m: 8, n: 3, nb: 2, offset: 0},
		{m: 8, n: 3, nb: 1, offset: 4},
		{m: 3, n: 8, nb: 2, offset: 0},
		{m: 3, n: 8, nb: 1, offset: 1},
		{m: 10, n: 10, nb: 3, offset: 0},
		{m: 10, n: 10, nb: 2, offset: 5},
	} {
		m := test.m
		n := test.n
		jpiv := make([]int, n)

		for _, extra := range []int{0, 11} {
			a := randomGeneral(m, n, n+extra, rnd)
			aCopy := cloneGeneral(a)

			for j := range jpiv {
				jpiv[j] = j
			}

			tau := make([]float64, n)
			vn1 := columnNorms(m, n, a.Data, a.Stride)
			vn2 := columnNorms(m, n, a.Data, a.Stride)
			auxv := make([]float64, test.nb)
			f := zeros(test.n, test.nb, n)

			kb := impl.Dlaqps(m, n, test.offset, test.nb, a.Data, a.Stride, jpiv, tau, vn1, vn2, auxv, f.Data, f.Stride)

			prefix := fmt.Sprintf("Case %v (m=%v,n=%v,offset=%d,nb=%v,extra=%v)", ti, m, n, test.offset, test.nb, extra)

			if !generalOutsideAllNaN(a) {
				t.Errorf("%v: out-of-range write to A", prefix)
			}
			if kb != test.nb {
				t.Logf("%v: %v columns out of %v factorized", prefix, kb, test.nb)
			}

			mo := m - test.offset
			if mo == 0 {
				continue
			}

			q := constructQ("QR", mo, kb, a.Data[test.offset*a.Stride:], a.Stride, tau)

			// Check that Q is orthogonal.
			if resid := residualOrthogonal(q, false); resid > tol {
				t.Errorf("%v: Q is not orthogonal; resid=%v, want<=%v", prefix, resid, tol)
			}

			// Check that |A*P - Q*R| is small.
			impl.Dlapmt(true, aCopy.Rows, aCopy.Cols, aCopy.Data, aCopy.Stride, jpiv)
			qrap := blas64.General{
				Rows:   mo,
				Cols:   kb,
				Stride: aCopy.Stride,
				Data:   aCopy.Data[test.offset*aCopy.Stride:],
			}
			r := zeros(mo, kb, n)
			for i := 0; i < mo; i++ {
				for j := i; j < kb; j++ {
					r.Data[i*r.Stride+j] = a.Data[(test.offset+i)*a.Stride+j]
				}
			}
			blas64.Gemm(blas.NoTrans, blas.NoTrans, 1, q, r, -1, qrap)
			resid := dlange(lapack.MaxColumnSum, qrap.Rows, qrap.Cols, qrap.Data, qrap.Stride)
			if resid > tol {
				t.Errorf("%v: |Q*R - A*P|=%v, want<=%v", prefix, resid, tol)
			}
		}
	}
}