src/hkl-pseudoaxis-K4CV.c

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