"""3D dam break with an obstacle simulation using PySPH.

For testing, we use the input geometry and discretization as the
SPHYSICS Case 5
(https://wiki.manchester.ac.uk/sphysics/index.php/SPHYSICS_Home_Page)

"""
import numpy as np

from pysph.base.utils import get_particle_array_wcsph as gpa

from pysph.sph.equation import Group
from pysph.base.kernels import CubicSpline
from pysph.sph.basic_equations import ContinuityEquation, XSPHCorrection
from pysph.sph.wc.basic import TaitEOS, MomentumEquation

from pysph.solver.application import Application
from pysph.solver.solver import Solver
from pysph.sph.integrator import Integrator, WCSPHStep

dim = 3

dt = 3e-5
tf = 1.0

hdx = 1.2
ro = 1000.0
co = 10.0 * np.sqrt(9.81*0.3)
gamma = 7.0
alpha = 0.1
beta = 0.0
B = co*co*ro/gamma
eps = 0.5

def create_particles(empty=False, **kwargs):
    ns = 13987
    dx = dy = dz = 0.0225
    #h0 = 0.9 * np.sqrt(3 * dx**2)
    h0 = hdx * dx

    import os
    path = os.path.dirname(os.path.abspath(__file__))

    ipart = os.path.join(path, 'IPART.txt.gz')
    ipart = np.loadtxt(ipart)

    x = ipart[:, 0]; y = ipart[:, 1]; z = ipart[:, 2]
    u = ipart[:, 3]; v = ipart[:, 4]; w = ipart[:, 5]
    rho = ipart[:, 6]; p = ipart[:, 7]; m = ipart[:, 8]

    # the fluid particles
    xf = x[ns:]; yf = y[ns:]; zf = z[ns:]
    rhof = rho[ns:]; pf = p[ns:]; mf = m[ns:]

    hf = np.ones_like(xf) * h0

    fluid = gpa(name='fluid', x=xf, y=yf, z=zf,
                rho=rhof, p=pf, m=mf, h=hf)

    # the solid particles
    xs = x[:ns]; ys = y[:ns]; zs = z[:ns]
    rhos = rho[:ns]; ps = p[:ns]; ms = m[:ns]

    hs = np.ones_like(xs) * h0

    solid = gpa(name='boundary', x=xs, y=ys, z=zs,
                rho=rhos, p=ps, m=ms, h=hs)

    particles = [fluid, solid]

    # add requisite variables
    for pa in particles:
        for name in ('arho', 'au', 'av', 'aw', 'ax', 'ay', 'az',
                     'rho0', 'u0', 'v0', 'w0', 'x0', 'y0', 'z0'):
            pa.add_property(name)

    return particles

# Create the application.
app = Application()

# Create the kernel
kernel = CubicSpline(dim=3)

# Create the integrator.
integrator = Integrator(fluid=WCSPHStep(), boundary=WCSPHStep())

# Create a solver.
solver = Solver(kernel=kernel, dim=dim, integrator=integrator)

# Setup default parameters.
solver.set_time_step(dt)
solver.set_final_time(tf)

# create the equations
equations = [

    # Equation of state
    Group(equations=[

            TaitEOS(dest='fluid', sources=None, rho0=ro, c0=co, gamma=gamma),
            TaitEOS(dest='boundary', sources=None, rho0=ro, c0=co, gamma=gamma),

            ]),

    # Continuity Momentum and XSPH equations
    Group(equations=[
               ContinuityEquation(dest='fluid', sources=['fluid', 'boundary']),
               ContinuityEquation(dest='boundary', sources=['fluid']),
               
               MomentumEquation(dest='fluid', sources=['fluid', 'boundary'],
                                alpha=alpha, beta=beta, gz=-9.81),

               # Position step with XSPH
               XSPHCorrection(dest='fluid', sources=['fluid'], eps=eps)
               ])
    ]

# Setup the application and solver.  This also generates the particles.
app.setup(solver=solver, equations=equations,
          particle_factory=create_particles)

app.run()
