// @(#) $Id: AliHLTTPCCAParam.cxx,v 1.3 2010/08/10 22:44:47 mzyzak Exp $
// **************************************************************************
// This file is property of and copyright by the ALICE HLT Project          *
// ALICE Experiment at CERN, All rights reserved.                           *
//                                                                          *
// Primary Authors: Sergey Gorbunov <sergey.gorbunov@kip.uni-heidelberg.de> *
//                  Ivan Kisel <kisel@kip.uni-heidelberg.de>                *
//                  for The ALICE HLT Project.                              *
//                                                                          *
// Developed by:   Igor Kulakov <I.Kulakov@gsi.de>                          *
//                 Maksym Zyzak <M.Zyzak@gsi.de>                            *
//                                                                          *
// Permission to use, copy, modify and distribute this software and its     *
// documentation strictly for non-commercial purposes is hereby granted     *
// without fee, provided that the above copyright notice appears in all     *
// copies and that both the copyright notice and this permission notice     *
// appear in the supporting documentation. The authors make no claims       *
// about the suitability of this software for any purpose. It is            *
// provided "as is" without express or implied warranty.                    *
//                                                                          *
//***************************************************************************


#include "AliHLTTPCCAParamArBB.h"
#include "AliHLTTPCCAParam.h"
#include "AliHLTTPCCATrackParamArBB.h"

AliHLTTPCCAParamArBB::AliHLTTPCCAParamArBB( const AliHLTTPCCAParam &ScalarParam )
{
  for( int i = 0; i < 6; ++i ) {
    fParamS0ParArBB[i] = fill(0,2);
    fParamS0ParArBB[i] = arbb::replace( fParamS0ParArBB[i], 0, ScalarParam.GetParamS0Par(0,0,i) );
    fParamS0ParArBB[i] = arbb::replace( fParamS0ParArBB[i], 1, ScalarParam.GetParamS0Par(0,1,i) );
  };

  fCBz = ScalarParam.cBz();
}

void AliHLTTPCCAParamArBB::GetClusterErrors2( dense<u8> iRow, const AliHLTTPCCATrackParamArBB &t, dense<f32> &Err2Y, dense<f32> &Err2Z ) const
{
  dense<f32> z = t.Z();
  dense<i32> type;
  errorType( iRow, type );
  z = (200.f - arbb::abs(z)) * 0.01f;
  z = select( z<0.f, 0.f, z );

  dense<f32> sin2Phi = t.SinPhi()*t.SinPhi();
  dense<f32> cos2Phi = (1.f - sin2Phi);
  cos2Phi = select( cos2Phi < 0.0001f, 0.0001f, cos2Phi );
  dense<f32> tg2Phi = sin2Phi/cos2Phi;

  dense<f32> tg2Lambda = t.DzDs()*t.DzDs();

  Err2Y = gather(fParamS0ParArBB[0], type) + gather(fParamS0ParArBB[1], type)*z/cos2Phi + gather(fParamS0ParArBB[2], type)*tg2Phi;
  Err2Z = gather(fParamS0ParArBB[3], type) + gather(fParamS0ParArBB[4], type)*z*(1.f+tg2Lambda) + gather(fParamS0ParArBB[5], type)*tg2Lambda;

  Err2Y = select( Err2Y<1e-6f, 1e-6f, Err2Y);
  Err2Z = select( Err2Z<1e-6f, 1e-6f, Err2Z);

  Err2Y = select( Err2Y>1.f, 1.f, Err2Y);
  Err2Z = select( Err2Z>1.f, 1.f, Err2Z);
}