/* D02PS_A1W_F C++ Header Example Program.
 *
 * Copyright 2020 Numerical Algorithms Group.
 *
 * Mark 27.1, 2020.
 */

#include <nag.h>
#include <dco.hpp>
#include <nagad.h>
#include <math.h>
#include <stdio.h>
#include <iostream>
using namespace std;

#ifdef __cplusplus
extern "C"
{
#endif
  static void NAG_CALL f(void * &ad_handle, const nagad_a1w_w_rtype &t,
                         const Integer &n, const nagad_a1w_w_rtype y[],
                         nagad_a1w_w_rtype yp[],
                         Integer iuser[], nagad_a1w_w_rtype ruser[]);
#ifdef __cplusplus
}
#endif

int main(void)
{
  const Integer     n = 2, npts = 16, nwant = 1;
  const Integer     liwsav = 130;
  const Integer     lrwsav = 350 + 32 * n;
  const Integer     lwcomm = n + 5 * nwant;

  Integer           exit_status = 0;

  nagad_a1w_w_rtype *rwsav = 0, *thresh = 0, *ynow = 0, *wcomm = 0;
  nagad_a1w_w_rtype *ypnow = 0, *y = 0, *ywant = 0, *ypwant = 0, ruser[2];
  Integer           *iwsav = 0, iuser[1];

  cout << "D02PS_A1W_F C++ Header Example Program Results\n\n";

  thresh = new nagad_a1w_w_rtype [n];
  ynow   = new nagad_a1w_w_rtype [n];
  y      = new nagad_a1w_w_rtype [n];
  ywant  = new nagad_a1w_w_rtype [n];
  ypnow  = new nagad_a1w_w_rtype [n];
  ypwant = new nagad_a1w_w_rtype [n];
  iwsav  = new Integer [liwsav];
  rwsav  = new nagad_a1w_w_rtype [lrwsav];
  wcomm  = new nagad_a1w_w_rtype [lwcomm];

  // Set initial conditions for ODE and parameters for the integrator.
  Integer           method = -1;
  nagad_a1w_w_rtype tol, hstart, tend, tstart;
  tstart    = 0.0;
  tol       = 1.0e-4;
  tend      = 2.0*nag_math_pi;
  hstart    = 0.0;
  for (int k = 0; k < n; k++) {
    thresh[k] = 1.0e-8;
  }
  ruser[0] = 1.0;
  ruser[1] = 1.0;
  y[0] = 0.0;
  y[1] = 1.0;
  
  {
    double tolr = nagad_a1w_get_value(tol);
    cout << "\n  Calculation with tol = " << tolr << endl;
  }
  cout.setf(ios::fixed);
  cout.setf(ios::right);
  cout.precision(3);
  {
    double t = nagad_a1w_get_value(tstart);
    cout << "\n    t         y1        y2" << endl;
    cout.width(6); cout << t;
  }

  // Create AD tape
  nagad_a1w_ir_create();

  // Create AD configuration data object
  Integer ifail = 0;
  void    *ad_handle = 0;
  x10aa_a1w_f_(ad_handle,ifail);
  
  nagad_a1w_ir_register_variable(&ruser[0]);
  nagad_a1w_ir_register_variable(&ruser[1]);

  for (int k = 0; k < n; k++) {
    double yr = nagad_a1w_get_value(y[k]);
    cout.width(10); cout << yr;
  }
  cout << endl;

  // Initialize Runge-Kutta method for integrating ODE
  ifail = 0;
  d02pq_a1w_f_(ad_handle,n,tstart,tend,y,tol,thresh,method,hstart,
               iwsav,rwsav,ifail);

  nagad_a1w_w_rtype tnow, twant, tinc;
  tinc = (tend-tstart)/( (double) npts);
  twant = tstart + tinc;
  tnow = tstart;
  while (tnow<tend) {
    ifail = 0;
    d02pf_a1w_f_(ad_handle,f,n,tnow,ynow,ypnow,iuser,ruser,
                 iwsav,rwsav,ifail);
    while (twant <= tnow) {
      Integer ideriv = 2;
      ifail = 0;
      d02ps_a1w_f_(ad_handle,n,twant,ideriv,nwant,ywant,ypwant,f,
                   wcomm,lwcomm,iuser,ruser,iwsav,rwsav,ifail);

      cout.width(6); cout << nagad_a1w_get_value(twant);
      cout.width(10); cout << nagad_a1w_get_value(ywant[0]);
      cout.width(10); cout << nagad_a1w_get_value(ypwant[0]);
      cout << endl;
      
      twant = twant + tinc;
    }
  }

  nagad_a1w_w_rtype hnext, waste;
  Integer           fevals, stepcost, stepsok;
  ifail = 0;
  d02pt_a1w_f_(ad_handle,fevals,stepcost,waste,stepsok,hnext,iwsav,
               rwsav,ifail);
  cout << "\n Cost of the integration in evaluations of f is " << fevals;
  cout << endl;

  // Setup evaluation of derivatives via adjoints.
  double inc = 1.0;
  nagad_a1w_inc_derivative(&ywant[0],inc);
  ifail = 0;
  nagad_a1w_ir_interpret_adjoint(ifail);

  cout << "\n Derivatives calculated: First order adjoints\n";
  cout << " Computational mode    : algorithmic\n";
  
  // Get derivatives
  cout << "\n Derivatives: (solution w.r.t. function parameters)\n";

  cout.setf(ios::scientific,ios::floatfield);
  cout.precision(5);
  double dr;
  dr = nagad_a1w_get_derivative(ruser[0]);
  cout << " dy(t)/druser[0] = ";
  cout.width(12); cout << dr << endl;
  dr = nagad_a1w_get_derivative(ruser[1]);
  cout << " dy(t)/druser[1] = ";
  cout.width(12); cout << dr << endl;

  ifail =0;
  x10ab_a1w_f_(ad_handle,ifail);
  nagad_a1w_ir_remove();

  delete [] thresh;
  delete [] ynow;
  delete [] y;
  delete [] ywant;
  delete [] ypnow;
  delete [] ypwant;
  delete [] iwsav;
  delete [] rwsav;
  delete [] wcomm;
  return exit_status;
}

static void NAG_CALL f(void * &ad_handle, const nagad_a1w_w_rtype &t,
                       const Integer &n, const nagad_a1w_w_rtype y[],
                       nagad_a1w_w_rtype yp[],
                       Integer iuser[], nagad_a1w_w_rtype ruser[])
{
  yp[0] = ruser[0]*y[1];
  yp[1] = -ruser[1]*y[0];
}