#include "stokes.hpp"

using namespace std::complex_literals;

int main() {

  Vector<std::complex<Real>> z(2), dz(2), ddz(2), dH(2);
  Matrix<std::complex<Real>> ddH(2, 2);

  z << -0.75067 - 0.190132 * 1i, -0.625994 + 0.665987 * 1i;
  dz << -0.0636149 - 0.469166 * 1i, 0.820037 - 0.449064 * 1i;
  ddz << 0.55777 + 0.730164 * 1i, 0.361959 - 0.463245 * 1i;
  dH << 0.967613 - 0.907519 * 1i, 0.712336 - 0.649056 * 1i;

  ddH << -0.371925 - 0.280788 * 1i, -0.163888 - 0.141297 * 1i,
         -0.163888 - 0.141297 * 1i, 0.230969 + 0.942449 * 1i;

  std::cout << zDot(z, dH) << std::endl << std::endl;

  std::cout << segmentCost(z, dz, dH) << std::endl << std::endl;

  std::cout << variation(z, dz, ddz, dH, ddH) << std::endl;

  return 0;
}