import torch

from vllm_ascend.utils import enable_custom_op

enable_custom_op()

DEFAULT_ATOL = 1e-3
DEFAULT_RTOL = 1e-3


def bgmv_expand_cpu_impl(x: torch.Tensor, w: torch.Tensor,
                         indices: torch.Tensor, y: torch.tensor,
                         slice_offset: int, slice_size: int) -> torch.Tensor:
    W = w[indices, :, :].transpose(-1, -2).to(torch.float32)
    z = torch.bmm(x.unsqueeze(1).to(torch.float32), W).squeeze()
    y[:, slice_offset:slice_offset + slice_size] += z
    return y


@torch.inference_mode()
def test_bgmv_expand() -> None:
    B = 1
    x = torch.randn([B, 16], dtype=torch.float)
    w = torch.randn([64, 128, 16], dtype=torch.float16)
    indices = torch.zeros([B], dtype=torch.int64)
    y = torch.randn([B, 128 * 3], dtype=torch.float16)

    x_npu = x.npu()
    w_npu = w.npu()
    indices_npu = indices.npu()
    y_npu = y.npu()

    y_out = bgmv_expand_cpu_impl(x, w, indices, y, 0, 128)
    y_out_npu = torch.ops._C.bgmv_expand(x_npu, w_npu, indices_npu, y_npu, 0,
                                         128)

    # Compare the results.
    torch.testing.assert_close(y_out_npu.cpu(),
                               y_out,
                               atol=DEFAULT_ATOL,
                               rtol=DEFAULT_RTOL)
