BEGIN_PROVIDER [ integer, dress_stoch_istate ]
  implicit none
  dress_stoch_istate = 1
END_PROVIDER

 BEGIN_PROVIDER [ integer, pt2_N_teeth ]
&BEGIN_PROVIDER [ integer, pt2_minDetInFirstTeeth ]
&BEGIN_PROVIDER [ integer, pt2_n_tasks_max ]
&BEGIN_PROVIDER [ integer, pt2_F, (N_det_generators) ]
  implicit none
  pt2_F(:) = 1
  !pt2_F(:N_det_generators/1000*0+50) = 1
  pt2_n_tasks_max = 16 ! N_det_generators/100 + 1
  
  if(N_det_generators < 256) then
    pt2_minDetInFirstTeeth = 1
    pt2_N_teeth = 1
  else
    pt2_minDetInFirstTeeth = min(5, N_det_generators)
    pt2_N_teeth = 16
  end if
END_PROVIDER



BEGIN_PROVIDER[ integer, dress_N_cp_max ]
  dress_N_cp_max = 32
END_PROVIDER

 BEGIN_PROVIDER[integer, pt2_J, (N_det_generators)]
&BEGIN_PROVIDER [integer, dress_R1, (0:N_det_generators) ]
  implicit none
  integer :: m,j
  integer :: l,nmov
  integer, allocatable :: iorder(:)
  allocate(iorder(N_det_generators))

  pt2_J = pt2_J_
  dress_R1 = dress_R1_

  do m=1,dress_N_cp
    nmov = 0
    l=dress_R1(m-1)+1
    do j=l, dress_R1(m)
      if(dress_M_mi(m, pt2_J(j)) == 0 .and. pt2_J(j) > dress_dot_n_0(m)) then
        pt2_J(j) += N_det_generators
        nmov += 1
      end if
    end do
    if(dress_R1(m)-dress_R1(m-1) > 0) then
      call isort(pt2_J(l), iorder, dress_R1(m)-dress_R1(m-1))
    end if
    dress_R1(m) -= nmov
    do j=dress_R1(m)+1, dress_R1(m) + nmov
      pt2_J(j) -= N_det_generators
    end do
  end do
END_PROVIDER

 BEGIN_PROVIDER[ integer, dress_M_m, (dress_N_cp_max)]
&BEGIN_PROVIDER[ integer, pt2_J_, (N_det_generators)]
&BEGIN_PROVIDER[ double precision, pt2_u, (N_det_generators)]
&BEGIN_PROVIDER[ integer, dress_R1_, (0:N_det_generators)]
&BEGIN_PROVIDER[ double precision, dress_M_mi, (dress_N_cp_max, N_det_generators+1)]
&BEGIN_PROVIDER [ integer, dress_T, (N_det_generators) ]
&BEGIN_PROVIDER [ integer, dress_N_cp ]
  implicit none
  integer :: N_c, N_j, U, t, i, m
  double precision :: v
  double precision, allocatable :: tilde_M(:)
  logical, allocatable :: d(:)
  integer, external :: dress_find_sample
  
  allocate(d(N_det_generators), tilde_M(N_det_generators))
  
  dress_M_mi = 0d0
  tilde_M = 0d0
  dress_R1_(:) = 0
  N_c = 0
  N_j = pt2_n_0(1)
  d(:) = .false.
  
  U = min(1, N_det_generators/(dress_N_cp_max**2/2))
  do i=1,dress_N_cp_max-1
    dress_M_m(i) = U * ((i**2-i)/2)! / (dress_N_cp_max+1)
  end do

  
  
  U = N_det_generators/((dress_N_cp_max**2+dress_N_cp_max)/2)+1
  do i=1, dress_N_cp_max
    dress_M_m(i) = U * (((i*i)+i)/2)
  end do

  dress_M_m(1) = 1
  dress_M_m(dress_N_cp_max) = N_det_generators+1

  do i=1,N_j
      d(i) = .true.
      pt2_J_(i) = i
  end do
  call random_seed(put=(/3211,64,6566,321,65,321,654,65,321,6321,654,65,321,621,654,65,321,65,654,65,321,65/)) 
  call RANDOM_NUMBER(pt2_u)
  call RANDOM_NUMBER(pt2_u)
  
  U = 0
  
  m = 1
  do while(N_j < N_det_generators)
    !ADD_COMB
    N_c += 1
    do t=0, pt2_N_teeth-1
      v = pt2_u_0 + pt2_W_T * (dble(t) + pt2_u(N_c))
      i = dress_find_sample(v, pt2_cW)
      tilde_M(i) += 1d0
      if(.not. d(i)) then
        N_j += 1
        pt2_J_(N_j) = i
        d(i) = .true.
      end if
    end do
   
    !FILL_TOOTH
    do while(U < N_det_generators)
      U += 1
      if(.not. d(U)) then
        N_j += 1
        pt2_J_(N_j) = U
        d(U) = .true.
        exit;
      end if
    end do
    
    if(N_c == dress_M_m(m)) then
      dress_R1_(m) = N_j
      dress_M_mi(m, :N_det_generators) = tilde_M(:)
      m += 1
    end if
  enddo
  
  dress_N_cp = m-1
  dress_R1_(dress_N_cp) = N_j
  dress_M_m(dress_N_cp) = N_c
  !!!!!!!!!!!!!!
 
  do i=1, pt2_n_0(1)
    dress_T(i) = 0
  end do
  
  do t=2,pt2_N_teeth+1
    do i=pt2_n_0(t-1)+1, pt2_n_0(t)
      dress_T(i) = t-1
    end do
  end do
  !!!!!!!!!!!!!
END_PROVIDER


subroutine ZMQ_dress(E, dress, delta_out, delta_s2_out, relative_error)
  use f77_zmq
  
  implicit none
  
  character(len=64000)           :: task
  integer(ZMQ_PTR)               :: zmq_to_qp_run_socket, zmq_socket_pull
  integer, external              :: omp_get_thread_num
  double precision, intent(in)   :: E(N_states), relative_error
  double precision, intent(out)  :: dress(N_states)
  double precision, intent(out)  :: delta_out(N_states, N_det)
  double precision, intent(out)  :: delta_s2_out(N_states, N_det)
  
  double precision, allocatable  :: delta(:,:)
  double precision, allocatable  :: delta_s2(:,:)
  
  integer                        :: i, j, k, Ncp
  
  integer, external              :: add_task_to_taskserver
  double precision               :: state_average_weight_save(N_states)
  task(:) = CHAR(0)
  allocate(delta(N_states,N_det), delta_s2(N_states, N_det))
  state_average_weight_save(:) = state_average_weight(:)
  do dress_stoch_istate=1,N_states
    SOFT_TOUCH dress_stoch_istate
    state_average_weight(:) = 0.d0
    state_average_weight(dress_stoch_istate) = 1.d0
    TOUCH state_average_weight
    
    !provide psi_coef_generators
    provide nproc mo_bielec_integrals_in_map mo_mono_elec_integral psi_selectors
    !print *, dress_e0_denominator
    
    print *, '========== ================= ================= ================='
    print *, ' Samples        Energy         Stat. Error         Seconds      '
    print *, '========== ================= ================= ================='
   
    call new_parallel_job(zmq_to_qp_run_socket,zmq_socket_pull, 'dress')
    
    integer, external              :: zmq_put_psi
    integer, external              :: zmq_put_N_det_generators
    integer, external              :: zmq_put_N_det_selectors
    integer, external              :: zmq_put_dvector
    integer, external              :: zmq_set_running

    if (zmq_put_psi(zmq_to_qp_run_socket,1) == -1) then
      stop 'Unable to put psi on ZMQ server'
    endif
    if (zmq_put_N_det_generators(zmq_to_qp_run_socket, 1) == -1) then
      stop 'Unable to put N_det_generators on ZMQ server'
    endif
    if (zmq_put_N_det_selectors(zmq_to_qp_run_socket, 1) == -1) then
      stop 'Unable to put N_det_selectors on ZMQ server'
    endif
    if (zmq_put_dvector(zmq_to_qp_run_socket,1,'energy',dress_e0_denominator,size(dress_e0_denominator)) == -1) then
      stop 'Unable to put energy on ZMQ server'
    endif
    if (zmq_put_dvector(zmq_to_qp_run_socket,1,"state_average_weight",state_average_weight,N_states) == -1) then
      stop 'Unable to put state_average_weight on ZMQ server'
    endif
    if (zmq_put_dvector(zmq_to_qp_run_socket,1,"dress_stoch_istate",real(dress_stoch_istate,8),1) == -1) then
      stop 'Unable to put dress_stoch_istate on ZMQ server'
    endif


    integer(ZMQ_PTR), external     :: new_zmq_to_qp_run_socket


    do i=1,N_det_generators
      do j=1,pt2_F(pt2_J(i))
        write(task(1:20),'(I9,1X,I9''|'')') j, pt2_J(i)
        if (add_task_to_taskserver(zmq_to_qp_run_socket,trim(task(1:20))) == -1) then
          stop 'Unable to add task to task server'
        endif
      end do
    end do
    if (zmq_set_running(zmq_to_qp_run_socket) == -1) then
      print *,  irp_here, ': Failed in zmq_set_running'
    endif
    
    !!$OMP PARALLEL DEFAULT(shared) NUM_THREADS(nproc)              &
    !    !$OMP  PRIVATE(i)
    !i = omp_get_thread_num()
    !if (i==0) then
      call dress_collector(zmq_socket_pull,E, relative_error, delta, delta_s2, dress,&
         dress_stoch_istate)
    !else
    !  call dress_slave_inproc(i)
    !endif
    !!$OMP END PARALLEL
    delta_out(dress_stoch_istate,1:N_det) = delta(dress_stoch_istate,1:N_det)
    delta_s2_out(dress_stoch_istate,1:N_det) = delta_s2(dress_stoch_istate,1:N_det)
    
    call end_parallel_job(zmq_to_qp_run_socket, zmq_socket_pull, 'dress')
    
    print *, '========== ================= ================= ================='
  enddo
  FREE dress_stoch_istate
  state_average_weight(:) = state_average_weight_save(:)
  TOUCH state_average_weight
  deallocate(delta,delta_s2)
  
end subroutine


subroutine dress_slave_inproc(i)
  implicit none
  integer, intent(in)            :: i
  
  call run_dress_slave(1,i,dress_e0_denominator)
end

 BEGIN_PROVIDER [integer, dress_dot_F, (dress_N_cp)]
&BEGIN_PROVIDER [ integer, dress_P, (N_det_generators) ]
  implicit none
  integer :: m,i
 
  do m=1,dress_N_cp
    do i=dress_R1(m-1)+1, dress_R1(m)
      dress_P(pt2_J(i)) = m
    end do
  end do
  
  dress_dot_F = 0
  do m=1,dress_N_cp
    do i=dress_R1(m-1)+1,dress_R1(m)
      dress_dot_F(m) += pt2_F(pt2_J(i))
    end do
  end do
  do m=2,dress_N_cp
    dress_dot_F(m) += dress_dot_F(m-1)
  end do
END_PROVIDER

BEGIN_PROVIDER [double precision, dress_e, (N_det_generators, dress_N_cp)]
&BEGIN_PROVIDER [integer, dress_dot_t, (0:dress_N_cp)]
&BEGIN_PROVIDER [integer, dress_dot_n_0, (0:dress_N_cp)] 
  implicit none
  
  logical, allocatable :: d(:)
  integer :: U, m, t, i
  
  allocate(d(N_det_generators+1))

  dress_e(:,:) = 0d0
  dress_dot_t(:) = 0
  dress_dot_n_0(:) = 0
  d(:) = .false.
  U=0
  
  do m=1,dress_N_cp
    do i=dress_R1_(m-1)+1,dress_R1_(m)
      !dress_dot_F(m) += pt2_F(pt2_J_(i))
      d(pt2_J_(i)) = .true.
    end do

    do while(d(U+1))
      U += 1
    end do
      
    dress_dot_t(m) = pt2_N_teeth + 1
    dress_dot_n_0(m) = N_det_generators
    
    do t = 2, pt2_N_teeth+1
      if(U < pt2_n_0(t)) then
        dress_dot_t(m) = t-1
        dress_dot_n_0(m) = pt2_n_0(t-1)
        exit
      end if
    end do
    do i=dress_dot_n_0(m)+1, N_det_generators !pt2_n_0(t+1)
      dress_e(i,m) = pt2_W_T * dress_M_mi(m,i) / pt2_w(i)
    end do
  end do
  
  do m=dress_N_cp, 2, -1
    dress_e(:,m) -= dress_e(:,m-1)
  end do
END_PROVIDER


subroutine dress_collector(zmq_socket_pull, E, relative_error, delta, delta_s2, dress, istate)
  use f77_zmq
  use bitmasks
  implicit none

  
  integer(ZMQ_PTR), intent(in)   :: zmq_socket_pull
  integer, intent(in)            :: istate

  double precision, intent(in)   :: relative_error, E(N_states)
  double precision, intent(out)  :: dress(N_states)

  double precision, intent(out)  :: delta(N_states, N_det)
  double precision, intent(out)  :: delta_s2(N_states, N_det)
  double precision, allocatable  :: breve_delta_m(:,:,:), S(:), S2(:)
  double precision, allocatable  :: edI(:,:), edI_task(:,:)
  integer, allocatable           :: edI_index(:)
  integer(ZMQ_PTR),external      :: new_zmq_to_qp_run_socket
  integer(ZMQ_PTR)               :: zmq_to_qp_run_socket

  integer(ZMQ_PTR), external     :: new_zmq_pull_socket, zmq_abort
  integer, allocatable :: task_id(:)
  integer :: i, c, j, k, f, t, m, p, m_task
  integer :: more, n_tasks
  double precision :: E0, error, x, v, time, time0
  double precision :: avg, eqt
  double precision, external :: omp_get_wtime
  integer, allocatable :: dot_f(:)
  integer, external :: zmq_delete_tasks, dress_find_sample
  logical :: found
  integer :: worker_id
  zmq_to_qp_run_socket = new_zmq_to_qp_run_socket()

  call connect_to_taskserver(zmq_to_qp_run_socket,worker_id,1)
  
  found = .false.
  delta = 0d0
  delta_s2 = 0d0
  allocate(task_id(pt2_n_tasks_max))
  allocate(edI(N_states, N_det))
  allocate(edI_task(N_states, N_det), edI_index(N_det))
  allocate(breve_delta_m(N_states, N_det, 2))
  allocate(dot_f(dress_N_cp+1))
  allocate(S(pt2_N_teeth+1), S2(pt2_N_teeth+1))
  edI = 0d0
  
  dot_f(:dress_N_cp) = dress_dot_F(:)
  dot_f(dress_N_cp+1) = 1
  more = 1
  m = 1
  c = 0
  S(:) = 0d0
  S2(:) = 0d0
  time0 = omp_get_wtime()
  more = 1

  do while (.not. found)
    if(dot_f(m) == 0) then
      E0 = 0
      do i=dress_dot_n_0(m),1,-1
        E0 += edI(dress_stoch_istate, i)
      end do
      do while(c < dress_M_m(m))
        c = c+1
        x = 0d0
        do p=pt2_N_teeth, 1, -1
          v = pt2_u_0 + pt2_W_T * (pt2_u(c) + dble(p-1))
          i = dress_find_sample(v, pt2_cW)
          x += edI(dress_stoch_istate, i) * pt2_W_T / pt2_w(i)
          S(p) += x
          S2(p) += x**2
        end do
      end do
      t = dress_dot_t(m)
      avg = S(t) / dble(c)
      eqt = (S2(t) / c) - (S(t)/c)**2
      eqt = sqrt(eqt / dble(c-1))
      error = eqt
      time = omp_get_wtime()
      print '(G10.3, 2X, F16.10, 2X, G16.3, 2X, F16.4, A20)', c, avg+E0+E(dress_stoch_istate), eqt, time-time0, ''
      m += 1
      if(eqt <= relative_error) then
        integer, external :: zmq_put_dvector
        i= zmq_put_dvector(zmq_to_qp_run_socket, worker_id, "ending", dble(m-1), 1)
        found = .true.
      end if
    else
      do
        call  pull_dress_results(zmq_socket_pull, m_task, f, edI_task, edI_index, breve_delta_m, task_id, n_tasks)
        if(m_task == 0) then
          if (zmq_delete_tasks(zmq_to_qp_run_socket,zmq_socket_pull,task_id,n_tasks,more) == -1) then
            stop 'Unable to delete tasks'
          endif
        else
          !if(task_id(1) /= 0) stop "TASKID"
          !i= zmq_delete_tasks(zmq_to_qp_run_socket,zmq_socket_pull,task_id,1,more)
          exit
        end if
      end do
      do i=1,n_tasks
        edI(:, edI_index(i)) += edI_task(:, i) 
      end do
      dot_f(m_task) -= f
    end if
  end do
  if (zmq_abort(zmq_to_qp_run_socket) == -1) then
    call sleep(1)
    if (zmq_abort(zmq_to_qp_run_socket) == -1) then
      print *, irp_here, ': Error in sending abort signal (2)'
    endif
  endif

  integer :: ff

  ff = dress_dot_F(m-1)
  delta= 0d0
  delta_s2 = 0d0
  do while(more /= 0)
    call  pull_dress_results(zmq_socket_pull, m_task, f, edI_task, edI_index, breve_delta_m, task_id, n_tasks)
    
   !if(task_id(0) == 0) cycle                                                                                    
   if(m_task == 0) then
       i = zmq_delete_tasks(zmq_to_qp_run_socket,zmq_socket_pull,task_id,n_tasks,more)                         
     else if(m_task < 0) then                                                                                                 
       i = zmq_delete_tasks(zmq_to_qp_run_socket,zmq_socket_pull,task_id,1,more)
     end if


    if(m_task >= 0) cycle
    ff = ff - f
    delta(:,:) += breve_delta_m(:,:,1)
    delta_s2(:,:) += breve_delta_m(:,:,2) 
  end do
  dress(istate) = E(istate)+E0+avg
  if(ff /= 0) stop "WRONG NUMBER OF FRAGMENTS COLLECTED"
  call disconnect_from_taskserver(zmq_to_qp_run_socket,worker_id)
  call end_zmq_to_qp_run_socket(zmq_to_qp_run_socket)
end subroutine


integer function dress_find_sample(v, w)
  implicit none
  double precision, intent(in) :: v, w(0:N_det_generators)
  integer :: i,l,r

  l = 0
  r = N_det_generators

  do while(r-l > 1)
    i = (r+l) / 2
    if(w(i) < v) then
      l = i
    else
      r = i
    end if
  end do

  dress_find_sample = r
end function



 BEGIN_PROVIDER [ double precision,     pt2_w, (N_det_generators) ] 
&BEGIN_PROVIDER [ double precision,     pt2_cW, (0:N_det_generators) ] 
&BEGIN_PROVIDER [ double precision,     pt2_W_T ]
&BEGIN_PROVIDER [ double precision,     pt2_u_0 ]
&BEGIN_PROVIDER [ integer,              pt2_n_0, (pt2_N_teeth+1) ]
  implicit none
  integer :: i, t
  double precision, allocatable :: tilde_w(:), tilde_cW(:)
  double precision :: r, tooth_width
  integer, external :: dress_find_sample

  allocate(tilde_w(N_det_generators), tilde_cW(0:N_det_generators))
  
  tilde_cW(0) = 0d0
  
  do i=1,N_det_generators
    tilde_w(i)  = psi_coef_generators(i,dress_stoch_istate)**2
    tilde_cW(i) = tilde_cW(i-1) + tilde_w(i)
  enddo
  
  pt2_n_0(1) = 0
  do
    pt2_u_0 = tilde_cW(pt2_n_0(1))
    r = tilde_cW(pt2_n_0(1) + pt2_minDetInFirstTeeth)
    pt2_W_T = (1d0 - pt2_u_0) / dble(pt2_N_teeth)
    if(pt2_W_T >= r - pt2_u_0) then
      exit
    end if
    pt2_n_0(1) += 1
    if(N_det_generators - pt2_n_0(1) < pt2_minDetInFirstTeeth * pt2_N_teeth) then
      stop "teeth building failed"
    end if
  end do
  !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
    
  do t=2, pt2_N_teeth
    r = pt2_u_0 + pt2_W_T * dble(t-1)
    pt2_n_0(t) = dress_find_sample(r, tilde_cW)
  end do
  pt2_n_0(pt2_N_teeth+1) = N_det_generators
    
  !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
  pt2_w(:pt2_n_0(1)) = tilde_w(:pt2_n_0(1))
  do t=1, pt2_N_teeth
    tooth_width = tilde_cW(pt2_n_0(t+1)) - tilde_cW(pt2_n_0(t))
    do i=pt2_n_0(t)+1, pt2_n_0(t+1)
      pt2_w(i) = tilde_w(i) * pt2_W_T / tooth_width
    end do
  end do
  
  pt2_cW(0) = 0d0
  do i=1,N_det_generators
    pt2_cW(i) = pt2_cW(i-1) + pt2_w(i)      
  end do
  pt2_n_0(pt2_N_teeth+1) = N_det_generators
END_PROVIDER