// Copyright (c) 2022 PaddlePaddle Authors. All Rights Reserved.
//
// Licensed under the Apache License, Version 2.0 (the "License");
// you may not use this file except in compliance with the License.
// You may obtain a copy of the License at
//
//     http://www.apache.org/licenses/LICENSE-2.0
//
// Unless required by applicable law or agreed to in writing, software
// distributed under the License is distributed on an "AS IS" BASIS,
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
// See the License for the specific language governing permissions and
// limitations under the License.

#include "paddle/phi/kernels/cross_kernel.h"

#include "paddle/fluid/framework/tensor_util.h"
#include "paddle/phi/backends/cpu/cpu_context.h"
#include "paddle/phi/core/dense_tensor.h"
#include "paddle/phi/core/kernel_registry.h"
#include "paddle/phi/kernels/funcs/common_shape.h"

namespace phi {

template <typename T, typename Context>
void CrossKernel(const Context& dev_ctx,
                 const DenseTensor& x,
                 const DenseTensor& y,
                 int axis,
                 DenseTensor* out) {
  auto& input_x = x;
  auto& input_y = y;
  auto* output = out;
  int dim = axis;

  auto input_x_dims = input_x.dims();

  if (dim != DDim::kMaxRank) {
    PADDLE_ENFORCE_EQ(
        dim < input_x_dims.size() && dim >= (0 - input_x_dims.size()),
        true,
        phi::errors::OutOfRange(
            "Attr(dim) is out of range, It's expected "
            "to be in range of [-%d, %d]. But received Attr(dim) = %d.",
            input_x_dims.size(),
            input_x_dims.size() - 1,
            dim));
    if (dim < 0) {
      dim += input_x_dims.size();
    }

    PADDLE_ENFORCE_EQ(
        input_x_dims[dim] == 3,
        true,
        phi::errors::InvalidArgument(
            "Input(X/Y).dims[dim] must be equal to 3. But received: "
            "Input(X/Y).dims[dim] = [%d].",
            input_x_dims[dim]));
  } else {
    for (auto i = 0; i < input_x_dims.size(); i++) {
      if (input_x_dims[i] == 3) {
        dim = i;
        break;
      }
    }
    PADDLE_ENFORCE_EQ(dim == DDim::kMaxRank,
                      false,
                      phi::errors::InvalidArgument(
                          "There must be at least one dimension 'd' so that "
                          "Input(X/Y).dims()[d] is equal to 3. "
                          "But received: Input(X/Y).dims() == [%s].",
                          input_x_dims));
  }
  auto outer_loops = 1;
  for (auto i = 0; i < dim; i++) {
    outer_loops *= input_x_dims[i];
  }
  auto slice_size = 1;
  for (auto i = dim + 1; i < input_x_dims.size(); i++) {
    slice_size *= input_x_dims[i];
  }

  std::vector<T> input_x_vec, input_y_vec;
  paddle::framework::TensorToVector(input_x, dev_ctx, &input_x_vec);
  paddle::framework::TensorToVector(input_y, dev_ctx, &input_y_vec);
  std::vector<T> out_vec(output->numel());

  dev_ctx.template Alloc<T>(output);

  for (auto i = 0; i < outer_loops; i++) {
    for (auto j = 0; j < 3; j++) {
      auto dst_pos = (3 * i + j) * slice_size;
      auto in_pos1 = (3 * i + ((j + 1) % 3)) * slice_size;
      auto in_pos2 = (3 * i + ((j + 2) % 3)) * slice_size;

      for (auto k = 0; k < slice_size; k++) {
        out_vec[dst_pos + k] =
            input_x_vec[in_pos1 + k] * input_y_vec[in_pos2 + k] -
            input_x_vec[in_pos2 + k] * input_y_vec[in_pos1 + k];
      }
    }
  }
  paddle::framework::TensorFromVector(out_vec, dev_ctx, output);
  output->Resize(input_x_dims);
}

}  // namespace phi

PD_REGISTER_KERNEL(
    cross, CPU, ALL_LAYOUT, phi::CrossKernel, float, double, int, int64_t) {}
