import numpy as np
import scipy.sparse as sp
import SimPEG
from SimPEG import Utils
from SimPEG.EM.Utils import omega
from SimPEG.Utils import Zero, Identity, sdiag


class Fields(SimPEG.Problem.Fields):
    """Fancy Field Storage for a FDEM survey."""
    knownFields = {}
    dtype = complex

class Fields_e(Fields):
    knownFields = {'eSolution':'E'}
    aliasFields = {
                    'e' : ['eSolution','E','_e'],
                    'ePrimary' : ['eSolution','E','_ePrimary'],
                    'eSecondary' : ['eSolution','E','_eSecondary'],
                    'b' : ['eSolution','F','_b'],
                    'bPrimary' : ['eSolution','F','_bPrimary'],
                    'bSecondary' : ['eSolution','F','_bSecondary'],
                    'j' : ['eSolution','CC','_j'],
                    'h' : ['eSolution','CC','_h'],
                  }

    def __init__(self,mesh,survey,**kwargs):
        Fields.__init__(self,mesh,survey,**kwargs)

    def startup(self):
        self.prob = self.survey.prob
        self._edgeCurl = self.survey.prob.mesh.edgeCurl
        self._aveE2CCV = self.survey.prob.mesh.aveE2CCV
        self._aveF2CCV = self.survey.prob.mesh.aveF2CCV
        self._nC = self.survey.prob.mesh.nC
        self._MeSigma = self.survey.prob.MeSigma
        self._MeSigmaDeriv = self.survey.prob.MeSigmaDeriv

    def _GLoc(self,fieldType):
        if fieldType == 'e':
            return 'E'
        elif fieldType == 'b':
            return 'F'
        elif (fieldType == 'h') or (fieldType == 'j'):
            return 'CC'
        else:
            raise Exception('Field type must be e, b, h, j')

    def _ePrimary(self, eSolution, srcList):
        ePrimary = np.zeros_like(eSolution)
        for i, src in enumerate(srcList):
            ep = src.ePrimary(self.prob)
            ePrimary[:,i] = ePrimary[:,i] + ep
        return ePrimary

    def _eSecondary(self, eSolution, srcList):
        return eSolution

    def _e(self, eSolution, srcList):
        return self._ePrimary(eSolution,srcList) + self._eSecondary(eSolution,srcList)

    def _eDeriv_u(self, src, v, eSolution, adjoint = False):
        return Identity()*v

    def _eDeriv_m(self, src, v, eSolution, adjoint = False):
        # assuming primary does not depend on the model
        return Zero()

    def _bPrimary(self, eSolution, srcList):
        bPrimary = np.zeros([self._edgeCurl.shape[0],eSolution.shape[1]],dtype = complex)
        for i, src in enumerate(srcList):
            bp = src.bPrimary(self.prob)
            bPrimary[:,i] = bPrimary[:,i] + bp
        return bPrimary

    def _bSecondary(self, eSolution, srcList):
        C = self._edgeCurl
        b = (C * eSolution)
        for i, src in enumerate(srcList):
            b[:,i] *= - 1./(1j*omega(src.freq))
            S_m, _ = src.eval(self.prob)
            b[:,i] = b[:,i]+ 1./(1j*omega(src.freq)) * S_m
        return b

    def _bSecondaryDeriv_u(self, src, v, eSolution, adjoint = False):
        C = self._edgeCurl
        if adjoint:
            return - 1./(1j*omega(src.freq)) * (C.T * v)
        return - 1./(1j*omega(src.freq)) * (C * v)

    def _bSecondaryDeriv_m(self, src, v, eSolution, adjoint = False):
        S_mDeriv, _ = src.evalDeriv(self.prob, adjoint)
        S_mDeriv = S_mDeriv(v)
        return 1./(1j * omega(src.freq)) * S_mDeriv

    def _b(self, eSolution, srcList):
        return self._bPrimary(eSolution, srcList) + self._bSecondary(eSolution, srcList)

    def _bDeriv_u(self, src, v, eSolution, adjoint = False):
        # Primary does not depend on u
        return self._bSecondaryDeriv_u(src, v, adjoint)

    def _bDeriv_m(self, src, v, eSolution, adjoint = False):
        # Assuming the primary does not depend on the model
        return self._bSecondaryDeriv_m(src, v, adjoint)

    def _j(self, eSolution, srcList):
        aveE2CCV = self._aveE2CCV
        n = int(aveE2CCV.shape[0] / self._nC) #TODO: This is a bit sloppy
        Sigma = self._MeSigma
        VI = sdiag(1./np.kron(np.ones(n), self.prob.mesh.vol))

        e = self._e(eSolution, srcList)
        return VI * (aveE2CCV * (Sigma *e) )

    def _jDeriv_u(self, src, eSolution, v, adjoint = False):
        aveE2CCV = self._aveE2CCV
        n = int(aveE2CCV.shape[0] / self._nC) #TODO: This is a bit sloppy
        Sigma = self._MeSigma

        VI = sdiag(1./np.kron(np.ones(n), self.prob.mesh.vol))

        if not adjoint: 
            return VI * (aveE2CCV * (Sigma * (self._eDeriv_u(src, v, adjoint) ) ) )
        return  self._eDeriv_u(src, Sigma.T * (aveE2CCV.T * (VI.T * v) ), adjoint)

    def _jDeriv_m(self, src, v, eSolution, adjoint = False):
        aveE2CCV = self._aveE2CCV
        Sigma = self._MeSigma
        SigmaDeriv = self._MeSigmaDeriv
        e = self._e(eSolution, [src])

        n = int(aveE2CCV.shape[0] / self._nC) #TODO: This is a bit sloppy
        
        VI = sdiag(1./np.kron(np.ones(n), self.prob.mesh.vol))

        if not adjoint:
            return VI * (aveE2CCV * ( SigmaDeriv(e) * v + self._eDeriv_m(src, v, adjoint) ))
        return SigmaDeriv(aveE2CCV.T * (VI.T * e), adjoint) * v + self._eDeriv_m(src, aveE2CCV.T * (VI.T * v), adjoint)


    def _h(self, eSolution, srcList):
        b = self._b(eSolution, srcList)
        Mui = self.survey.prob.MfMui
        aveF2CCV = self._aveF2CCV
        n = int(aveF2CCV.shape[0] / self._nC) #TODO: This is a bit sloppy
        # Mui = sdiag(sp.kron(np.ones(n), mui))
        VI = sdiag(1./np.kron(np.ones(n), self.prob.mesh.vol))


        return VI * (aveF2CCV * (Mui * b))



class Fields_b(Fields):
    knownFields = {'bSolution':'F'}
    aliasFields = {
                    'b' : ['bSolution','F','_b'],
                    'bPrimary' : ['bSolution','F','_bPrimary'],
                    'bSecondary' : ['bSolution','F','_bSecondary'],
                    'e' : ['bSolution','E','_e'],
                    'ePrimary' : ['bSolution','E','_ePrimary'],
                    'eSecondary' : ['bSolution','E','_eSecondary'],
                    'j' : ['bSolution','C','_j'],
                    'h' : ['bSolution','C','_h'],
                  }

    def __init__(self,mesh,survey,**kwargs):
        Fields.__init__(self,mesh,survey,**kwargs)

    def startup(self):
        self.prob = self.survey.prob
        self._edgeCurl = self.survey.prob.mesh.edgeCurl
        self._MeSigmaI = self.survey.prob.MeSigmaI
        self._MfMui = self.survey.prob.MfMui
        self._MeSigmaIDeriv = self.survey.prob.MeSigmaIDeriv
        self._Me = self.survey.prob.Me
        self._aveF2CCV = self.survey.prob.mesh.aveF2CCV
        self._aveE2CCV = self.survey.prob.mesh.aveE2CCV
        self._sigma = self.survey.prob.curModel.sigma
        self._mui = self.survey.prob.curModel.mui
        self._nC = self.survey.prob.mesh.nC



    def _GLoc(self,fieldType):
        if fieldType == 'e':
            return 'E'
        elif fieldType == 'b':
            return 'F'
        elif (fieldType == 'h') or (fieldType == 'j'):
            return'CC'
        else:
            raise Exception('Field type must be e, b, h, j')

    def _bPrimary(self, bSolution, srcList):
        bPrimary = np.zeros_like(bSolution)
        for i, src in enumerate(srcList):
            bp = src.bPrimary(self.prob)
            bPrimary[:,i] = bPrimary[:,i] + bp
        return bPrimary

    def _bSecondary(self, bSolution, srcList):
        return bSolution

    def _b(self, bSolution, srcList):
        return self._bPrimary(bSolution, srcList) + self._bSecondary(bSolution, srcList)

    def _bDeriv_u(self, src, v, adjoint=False):
        return Identity()*v

    def _bDeriv_m(self, src, v, adjoint=False):
        # assuming primary does not depend on the model
        return Zero()

    def _ePrimary(self, bSolution, srcList):
        ePrimary = np.zeros([self._edgeCurl.shape[1],bSolution.shape[1]],dtype = complex)
        for i,src in enumerate(srcList):
            ep = src.ePrimary(self.prob)
            ePrimary[:,i] = ePrimary[:,i] + ep
        return ePrimary

    def _eSecondary(self, bSolution, srcList):
        e = self._MeSigmaI * ( self._edgeCurl.T * ( self._MfMui * bSolution))
        for i,src in enumerate(srcList):
            _,S_e = src.eval(self.prob)
            e[:,i] = e[:,i]+ -self._MeSigmaI * S_e
        return e

    def _eSecondaryDeriv_u(self, src, v, adjoint=False):
        if not adjoint:
            return self._MeSigmaI * ( self._edgeCurl.T * ( self._MfMui * v) )
        else:
            return self._MfMui.T * (self._edgeCurl * (self._MeSigmaI.T * v))

    def _eSecondaryDeriv_m(self, src, v, adjoint=False):
        bSolution = self[[src],'bSolution']
        _,S_e = src.eval(self.prob)
        Me = self._Me

        if adjoint:
            Me = Me.T

        w = self._edgeCurl.T * (self._MfMui * bSolution)
        w = w - Utils.mkvc(Me * S_e,2)

        if not adjoint:
            de_dm = self._MeSigmaIDeriv(w) * v
        elif adjoint:
            de_dm = self._MeSigmaIDeriv(w).T * v

        _, S_eDeriv = src.evalDeriv(self.prob, adjoint)
        Se_Deriv = S_eDeriv(v)

        de_dm = de_dm - self._MeSigmaI * Se_Deriv

        return de_dm

    def _e(self, bSolution, srcList):
        return self._ePrimary(bSolution, srcList) + self._eSecondary(bSolution, srcList)

    def _eDeriv_u(self, src, v, adjoint=False):
        return self._eSecondaryDeriv_u(src, v, adjoint)

    def _eDeriv_m(self, src, v, adjoint=False):
        # assuming primary doesn't depend on model
        return self._eSecondaryDeriv_m(src, v, adjoint)

    def _j(self, bSolution, srcList):
        sigma = self._sigma
        aveE2CCV = self._aveE2CCV
        n = int(aveE2CCV.shape[0] / self._nC) #TODO: This is a bit sloppy
        # Sigma = sdiag(np.kron(np.ones(n), sigma))
        Sigma = self.prob.MeSigma
        VI = sdiag(1./np.kron(np.ones(n), self.prob.mesh.vol))

        e = self._e(bSolution, srcList)

        return VI * (aveE2CCV * (Sigma *e) )

    def _h(self, bSolution, srcList):
        b = self._b(bSolution, srcList)
        Mui = self.survey.prob.MfMui
        aveF2CCV = self._aveF2CCV
        n = int(aveF2CCV.shape[0] / self._nC) #TODO: This is a bit sloppy
        # Mui = sdiag(sp.kron(np.ones(n), mui))
        VI = sdiag(1./np.kron(np.ones(n), self.prob.mesh.vol))


        return VI * (aveF2CCV * (Mui * b))


class Fields_j(Fields):
    knownFields = {'jSolution':'F'}
    aliasFields = {
                    'j' : ['jSolution','F','_j'],
                    'jPrimary' : ['jSolution','F','_jPrimary'],
                    'jSecondary' : ['jSolution','F','_jSecondary'],
                    'h' : ['jSolution','E','_h'],
                    'hPrimary' : ['jSolution','E','_hPrimary'],
                    'hSecondary' : ['jSolution','E','_hSecondary'],
                    'e' : ['jSolution','C','_e'],
                    'b' : ['jSolution','C','_b'],
                  }

    def __init__(self,mesh,survey,**kwargs):
        Fields.__init__(self,mesh,survey,**kwargs)

    def startup(self):
        self.prob = self.survey.prob
        self._edgeCurl = self.survey.prob.mesh.edgeCurl
        self._MeMuI = self.survey.prob.MeMuI
        self._MfRho = self.survey.prob.MfRho
        self._MfRhoDeriv = self.survey.prob.MfRhoDeriv
        self._Me = self.survey.prob.Me
        self._rho = self.survey.prob.curModel.rho
        self._mu = self.survey.prob.curModel.mui
        self._aveF2CCV = self.survey.prob.mesh.aveF2CCV
        self._aveE2CCV = self.survey.prob.mesh.aveE2CCV
        self._nC = self.survey.prob.mesh.nC

    def _GLoc(self,fieldType):
        if fieldType == 'h':
            return 'E'
        elif fieldType == 'j':
            return 'F'
        elif (fieldType == 'e') or (fieldType == 'b'):
            return 'CC'
        else:
            raise Exception('Field type must be e, b, h, j')

    def _jPrimary(self, jSolution, srcList):
        jPrimary = np.zeros_like(jSolution,dtype = complex)
        for i, src in enumerate(srcList):
            jp = src.jPrimary(self.prob)
            jPrimary[:,i] = jPrimary[:,i] + jp
        return jPrimary

    def _jSecondary(self, jSolution, srcList):
        return jSolution

    def _j(self, jSolution, srcList):
        return self._jPrimary(jSolution, srcList) + self._jSecondary(jSolution, srcList)

    def _jDeriv_u(self, src, v, adjoint=False):
        return Identity()*v

    def _jDeriv_m(self, src, v, adjoint=False):
        # assuming primary does not depend on the model
        return Zero()

    def _hPrimary(self, jSolution, srcList):
        hPrimary = np.zeros([self._edgeCurl.shape[1],jSolution.shape[1]],dtype = complex)
        for i, src in enumerate(srcList):
            hp = src.hPrimary(self.prob)
            hPrimary[:,i] = hPrimary[:,i] + hp
        return hPrimary

    def _hSecondary(self, jSolution, srcList):
        h =  self._MeMuI * (self._edgeCurl.T * (self._MfRho * jSolution) )
        for i, src in enumerate(srcList):
            h[:,i] *= -1./(1j*omega(src.freq))
            S_m,_ = src.eval(self.prob)
            h[:,i] = h[:,i]+ 1./(1j*omega(src.freq)) * self._MeMuI * (S_m)
        return h

    def _hSecondaryDeriv_u(self, src, v, adjoint=False):
        if not adjoint:
            return  -1./(1j*omega(src.freq)) * self._MeMuI * (self._edgeCurl.T * (self._MfRho * v) )
        elif adjoint:
            return  -1./(1j*omega(src.freq)) * self._MfRho.T * (self._edgeCurl * ( self._MeMuI.T * v))

    def _hSecondaryDeriv_m(self, src, v, adjoint=False):
        jSolution = self[[src],'jSolution']
        MeMuI = self._MeMuI
        C = self._edgeCurl
        MfRho = self._MfRho
        MfRhoDeriv = self._MfRhoDeriv
        Me = self._Me

        if not adjoint:
            hDeriv_m =  -1./(1j*omega(src.freq)) * MeMuI * (C.T * (MfRhoDeriv(jSolution)*v ) )
        elif adjoint:
            hDeriv_m =  -1./(1j*omega(src.freq)) * MfRhoDeriv(jSolution).T * ( C * (MeMuI.T * v ) )

        S_mDeriv,_ = src.evalDeriv(self.prob, adjoint)

        if not adjoint:
            S_mDeriv = S_mDeriv(v)
            hDeriv_m = hDeriv_m + 1./(1j*omega(src.freq)) * MeMuI * (Me * S_mDeriv)
        elif adjoint:
            S_mDeriv = S_mDeriv(Me.T * (MeMuI.T * v))
            hDeriv_m = hDeriv_m + 1./(1j*omega(src.freq)) * S_mDeriv
        return hDeriv_m


    def _h(self, jSolution, srcList):
        return self._hPrimary(jSolution, srcList) + self._hSecondary(jSolution, srcList)

    def _hDeriv_u(self, src, v, adjoint=False):
        return self._hSecondaryDeriv_u(src, v, adjoint)

    def _hDeriv_m(self, src, v, adjoint=False):
        # assuming the primary doesn't depend on the model
        return self._hSecondaryDeriv_m(src, v, adjoint)

    def _e(self, jSolution, srcList):
        rho = self._rho
        aveF2CCV = self._aveF2CCV
        n = int(aveF2CCV.shape[0] / self._nC) #TODO: This is a bit sloppy
        
        Rho = self.prob.MfRho
        VI = sdiag(1./np.kron(np.ones(n), self.prob.mesh.vol))


        j = self._j(jSolution, srcList)

        return VI * (aveF2CCV * (Rho *  j)) 

    def _eDeriv_u(self, src, v, adjoint=False):
        raise NotImplementedError

    def _eDeriv_m(self, src, v, adjoint=False):
        raise NotImplementedError

    def _b(self, jSolution, srcList):
        h = self._h(jSolution, srcList)
        Mu = self.prob.MeMu
        aveE2CCV = self._aveE2CCV
        n = int(aveE2CCV.shape[0] / self._nC) #TODO: This is a bit sloppy
        # Mu = sdiag(sp.kron(np.ones(n), mu))
        VI = sdiag(1./np.kron(np.ones(n), self.prob.mesh.vol))

        return VI * (aveE2CCV * (Mu * h))


class Fields_h(Fields):
    knownFields = {'hSolution':'E'}
    aliasFields = {
                    'h' : ['hSolution','E','_h'],
                    'hPrimary' : ['hSolution','E','_hPrimary'],
                    'hSecondary' : ['hSolution','E','_hSecondary'],
                    'j' : ['hSolution','F','_j'],
                    'jPrimary' : ['hSolution','F','_jPrimary'],
                    'jSecondary' : ['hSolution','F','_jSecondary'],
                    'e' : ['hSolution','C','_e'],
                    'b' : ['hSolution','C','_b'],
                  }

    def __init__(self,mesh,survey,**kwargs):
        Fields.__init__(self,mesh,survey,**kwargs)

    def startup(self):
        self.prob = self.survey.prob
        self._edgeCurl = self.survey.prob.mesh.edgeCurl
        self._MeMuI = self.survey.prob.MeMuI
        self._MfRho = self.survey.prob.MfRho
        self._rho = self.survey.prob.curModel.rho
        self._mu = self.survey.prob.curModel.mui
        self._aveF2CCV = self.survey.prob.mesh.aveF2CCV
        self._aveE2CCV = self.survey.prob.mesh.aveE2CCV
        self._nC = self.survey.prob.mesh.nC

    def _GLoc(self,fieldType):
        if fieldType == 'h':
            return 'E'
        elif fieldType == 'j':
            return 'F'
        elif (fieldType == 'e') or (fieldType == 'b'):
            return 'CC'
        else:
            raise Exception('Field type must be e, b, h, j')

    def _hPrimary(self, hSolution, srcList):
        hPrimary = np.zeros_like(hSolution,dtype = complex)
        for i, src in enumerate(srcList):
            hp = src.hPrimary(self.prob)
            hPrimary[:,i] = hPrimary[:,i] + hp
        return hPrimary

    def _hSecondary(self, hSolution, srcList):
        return hSolution

    def _h(self, hSolution, srcList):
        return self._hPrimary(hSolution, srcList) + self._hSecondary(hSolution, srcList)

    def _hDeriv_u(self, src, v, adjoint=False):
        return Identity()*v

    def _hDeriv_m(self, src, v, adjoint=False):
        # assuming primary does not depend on the model
        return Zero()

    def _jPrimary(self, hSolution, srcList):
        jPrimary = np.zeros([self._edgeCurl.shape[0], hSolution.shape[1]], dtype = complex)
        for i, src in enumerate(srcList):
            jp = src.jPrimary(self.prob)
            jPrimary[:,i] = jPrimary[:,i] + jp
        return jPrimary

    def _jSecondary(self, hSolution, srcList):
        j = self._edgeCurl*hSolution
        for i, src in enumerate(srcList):
            _,S_e = src.eval(self.prob)
            j[:,i] = j[:,i]+ -S_e
        return j

    def _jSecondaryDeriv_u(self, src, v, adjoint=False):
        if not adjoint:
            return self._edgeCurl*v
        elif adjoint:
            return self._edgeCurl.T*v

    def _jSecondaryDeriv_m(self, src, v, adjoint=False):
        _,S_eDeriv = src.evalDeriv(self.prob, adjoint)
        S_eDeriv = S_eDeriv(v)
        return -S_eDeriv

    def _j(self, hSolution, srcList):
        return self._jPrimary(hSolution, srcList) + self._jSecondary(hSolution, srcList)

    def _jDeriv_u(self, src, v, adjoint=False):
        return self._jSecondaryDeriv_u(src,v,adjoint)

    def _jDeriv_m(self, src, v, adjoint=False):
        # assuming the primary does not depend on the model
        return self._jSecondaryDeriv_m(src,v,adjoint)
    
    def _e(self, hSolution, srcList):
        rho = self._rho
        aveF2CCV = self._aveF2CCV
        n = int(aveF2CCV.shape[0] / self._nC) #TODO: This is a bit sloppy
        
        Rho = self.prob.MfRho
        VI = sdiag(1./np.kron(np.ones(n), self.prob.mesh.vol))


        j = self._j(hSolution, srcList)

        return VI * (aveF2CCV * (Rho *  j)) 

    def _eDeriv_u(self, src, v, adjoint=False):
        raise NotImplementedError

    def _eDeriv_m(self, src, v, adjoint=False):
        raise NotImplementedError

    def _b(self, hSolution, srcList):
        h = self._h(hSolution, srcList)
        Mu = self.prob.MeMu
        aveE2CCV = self._aveE2CCV
        n = int(aveE2CCV.shape[0] / self._nC) #TODO: This is a bit sloppy
        # Mu = sdiag(sp.kron(np.ones(n), mu))
        VI = sdiag(1./np.kron(np.ones(n), self.prob.mesh.vol))

        return VI * (aveE2CCV * (Mu * h))