#----------------------------------------------------------------------
# Python interface for ISPACK3
# Copyright (C) 2023--2024 Toshiki Matsushima <toshiki@gfd-dennou.org>
#
# This library is free software; you can redistribute it and/or
# modify it under the terms of the GNU Lesser General Public
# License as published by the Free Software Foundation; either
# version 2.1 of the License, or (at your option) any later version.
#
# This library is distributed in the hope that it will be useful,
# but WITHOUT ANY WARRANTY; without even the implied warranty of
# MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
# Lesser General Public License for more details.
# 
# You should have received a copy of the GNU Lesser General Public
# License along with this library; if not, write to the Free Software
# Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
# 02110-1301 USA.
#----------------------------------------------------------------------
from mpi4py import MPI
import numpy as np
import time
import ispack3 as isp

jm  = 2**10
ntr = 10
mm  = jm-1
im  = jm*2
nm  = mm
nn  = nm

ig=1
ipow=0

it, t, r = isp.sxini1(mm, nm, im)
p, jc = isp.sxini2(mm, nm, jm, ig, r)

g_shape = (jm,im)
W_shape = (jm*im)
s_shape = ((2*nn+1-mm)*mm+nn+1,)

G = isp.aligned_array(g_shape, align=64)
W = isp.aligned_array(W_shape, dtype=np.float64, align=64)
S = np.empty(s_shape, dtype=np.float64)

np.random.seed(0)
S = 2 * np.random.rand(*S.shape) - 1
SD = S.copy()

print("MM=", mm, ", IM=", im, ", JM=", jm, ", NTR=", ntr)
print("SSE=", isp.mxgcpu())
print("number of threads =", isp.mxgomp())

rc=5*im*np.log(im)/np.log(2.0)*0.5*jm+(mm+1)*(mm+1)*jm    

start_time = time.perf_counter()

for n in range(ntr):    
    isp.sxts2g(mm, nm, nm, im, jm, S, G, it, t, p, r, jc, W, ipow)
    
elapsed_time = time.perf_counter() - start_time

GFLOPS=rc*ntr/elapsed_time/10**9

print("S2G:", elapsed_time/ntr, "sec (", GFLOPS, "GFlops)")

start_time = time.perf_counter()

for n in range(ntr):
    isp.sxtg2s(mm, nm, nm, im, jm, S, G, it, t, p, r, jc, W, ipow)

elapsed_time = time.perf_counter() - start_time


GFLOPS=rc*ntr/elapsed_time/10**9

print("G2S:", elapsed_time/ntr, "sec (", GFLOPS, "GFlops)")

l = np.arange(len(S))
n, m = isp.sxl2nm(nn, l)
    
SL_values = np.zeros_like(S, dtype=np.float64)
SL_values[m == 0] = np.abs(SD[m == 0] - S[m == 0])
SL_values[m > 0] = np.sqrt((SD[m > 0] - S[m > 0])**2 + (SD[m < 0] - S[m < 0])**2)

SLMAX = np.max(SL_values)
LAS = l[np.argmax(SL_values)]

SLAMAX = np.sum(SL_values**2)

n, m = isp.sxl2nm(mm, LAS)

print("maxerror=", SLMAX, "(n=", n, ", m=", m, ")" )
print("rmserror=", np.sqrt(SLAMAX/((mm+1)*(mm+2)/2) ) )