{% extends "ordered.tpl" %}

{% block code %}

void ssm_eval_Ht(ssm_X_t *p_X, ssm_row_t *row, double t, ssm_par_t *par, ssm_nav_t *nav, ssm_calc_t *calc)
{

    double *X = p_X->proj;
    int i, j;
    gsl_matrix *Ht = calc->_Ht;
    int m = nav->states_sv->length + nav->states_inc->length + nav->states_diff->length;

    ssm_it_states_t *states_inc = nav->states_inc;
    ssm_it_states_t *states_sv = nav->states_sv;
    ssm_it_states_t *states_diff = nav->states_diff;

    {% if is_diff  %}
    int is_diff = ! (nav->noises_off & SSM_NO_DIFF);
    double diffed[states_diff->length];
    {% endif %}

    //reset Ht.
    gsl_matrix_set_zero(Ht);

    {% if is_diff %}
    for(i=0; i<states_diff->length; i++){
        ssm_state_t *p = states_diff->p[i];
        {% if noises_off != 'ode'%}
        if(is_diff){
            diffed[i] = p->f_inv(X[p->offset]);
        } else {
            diffed[i] = gsl_vector_get(par, p->ic->offset);
        }
        {% else %}
        diffed[i] = gsl_vector_get(par, p->ic->offset);
        {% endif %}
    }
    {% endif %}

    // Derivatives of observed means against state variables
    {% for Ht_i in Ht.Ht_sv %}
    {% set outer_loop = loop %}
    {% for Ht_ii in Ht_i %}
    gsl_matrix_set(Ht,
                   states_sv->p[{{ outer_loop.index0 }}]->offset,
                   {{ loop.index0 }},
                   {{ Ht_ii|safe }});
    {% endfor %}
    {% endfor %}

    // Derivatives of observed means against incidence variables
    {% for Ht_i in Ht.Ht_inc %}
    {% set outer_loop = loop %}
    {% for Ht_ii in Ht_i %}
    gsl_matrix_set(Ht,
                   states_inc->p[{{ outer_loop.index0 }}]->offset,
                   {{ loop.index0 }},
                   {{ Ht_ii|safe }});
    {% endfor %}
    {% endfor %}

    // Derivatives of observed means against diffusing variables
    {% for Ht_i in Ht.Ht_diff %}
    {% set outer_loop = loop %}
    {% for Ht_ii in Ht_i %}
    gsl_matrix_set(Ht,
                   states_diff->p[{{ outer_loop.index0 }}]->offset,
                   {{ loop.index0 }},
                   {{ Ht_ii|safe }});
    {% endfor %}
    {% endfor %}


    for(i=0; i< m; i++){
        for(j=0; j< row->ts_nonan_length; j++){
            gsl_matrix_set(Ht,i,j, gsl_matrix_get(Ht,i,row->observed[j]->offset));
        }
    }
}

{% endblock %}