include/hkl/hkl-pseudoaxis-K4CV.h

   1 #ifndef __HKL_PSEUDOAXIS_K4CV_H__
   2 #define __HKL_PSEUDOAXIS_K4CV_H__
   3
   4 #include <gsl/gsl_math.h>
   5 #include <gsl/gsl_vector.h>
   6 #include <gsl/gsl_sf_trig.h>
   7
   8 #include <hkl/hkl-pseudoaxis.h>
   9 #include <hkl/hkl-pseudoaxis-common.h>
  10
  11 HKL_BEGIN_DECLS
  12
  13 static int K4CV_bissector_f1(const gsl_vector *x, void *params, gsl_vector *f)
  14 {
  15         double komega, tth, kappa, omega;
  16         size_t i;
  17         HklPseudoAxisEngine *engine;
  18         double const *x_data = gsl_vector_const_ptr(x, 0);
  19         double *f_data = gsl_vector_ptr(f, 0);
  20
  21         engine = params;
  22
  23         for(i=0; i<x->size;++i)
  24                 if (gsl_isnan(x_data[i]))
  25                         return GSL_ENOMEM;
  26
  27         RUBh_minus_Q(x_data, params, f_data);
  28
  29         komega = x_data[0];
  30         kappa = x_data[1];
  31         tth = gsl_sf_angle_restrict_symm(x_data[3]);
  32
  33         omega = komega + atan(tan(kappa/2.)*cos(50 * HKL_DEGTORAD)) + M_PI_2;
  34         omega = gsl_sf_angle_restrict_symm(omega);
  35         //f_data[3] = tth - 2 * fmod(omega,M_PI);
  36         f_data[3] = tth - 2*omega;
  37
  38         return  GSL_SUCCESS;
  39 }
  40
  41 static int K4CV_bissector_f2(const gsl_vector *x, void *params, gsl_vector *f)
  42 {
  43         double komega, tth, kappa, omega;
  44         size_t i;
  45         HklPseudoAxisEngine *engine;
  46         double const *x_data = gsl_vector_const_ptr(x, 0);
  47         double *f_data = gsl_vector_ptr(f, 0);
  48
  49         engine = params;
  50
  51         for(i=0; i<x->size;++i)
  52                 if (gsl_isnan(x_data[i]))
  53                         return GSL_ENOMEM;
  54
  55         RUBh_minus_Q(x_data, params, f_data);
  56
  57         komega = x_data[0];
  58         kappa = x_data[1];
  59         tth = gsl_sf_angle_restrict_symm(x_data[3]);
  60
  61         omega = komega + atan(tan(kappa/2.)*cos(50 * HKL_DEGTORAD)) - M_PI_2;
  62         omega = gsl_sf_angle_restrict_symm(omega);
  63         //f_data[3] = tth - 2 * fmod(omega,M_PI);
  64         f_data[3] = tth - 2*omega;
  65
  66         return  GSL_SUCCESS;
  67 }
  68
  69 HklPseudoAxisEngine *hkl_pseudoAxisEngine_new_K4CV_HKL(void)
  70 {
  71         HklPseudoAxisEngine *self;
  72         HklPseudoAxisEngineFunc *function;
  73         HklPseudoAxisEngineGetSet *getset;
  74
  75         self = hkl_pseudoAxisEngine_new("hkl", 3, "h", "k", "l");
  76
  77         /* hkl get/set bissector */
  78         getset = hkl_pseudo_axis_engine_get_set_new(
  79                         "bissector",
  80                         hkl_pseudo_axis_engine_getter_func_hkl,
  81                         NULL,
  82                         0,
  83                         4, "komega", "kappa", "kphi", "tth");
  84         hkl_pseudoAxisEngine_add_get_set(self, getset);
  85
  86         /* bissector */
  87         function = hkl_pseudo_axis_engine_func_new(
  88                         "bissector",
  89                         2, K4CV_bissector_f1, K4CV_bissector_f2,
  90                         0,
  91                         4, "komega", "kappa", "kphi", "tth");
  92         hkl_pseudoAxisEngine_add_function(self, function);
  93
  94         return self;
  95 }
  96
  97 HKL_END_DECLS
  98
  99 #endif /* __HKL_PSEUDOAXIS_E4CV_H__ */