maginvlib/magdata.cpp at master · mikhailtchernychev/maginvlib · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
//
// @(#)magdata.cpp  1.1  misha-13may103
//
// Copyright (c) 2003 of Geometrics.
// All rights reserved.
//
// Created:  13may103  by  misha@misha.local
// Version:  13may103  by  misha@misha.local
//


#include "magdata.h"
#include "magfunc.h"

CMagData::CMagData():CMagObject(0, MAX_FIELD_PARAMS, MAX_FIELD_PARAMS, "data") {

  m_iFieldType = totalmagfield;

  for(int i=0; i< MAX_FIELD_PARAMS; i++) {
    CMagObject::FixNonLinearParam(i, TRUE, 0.);
    CMagObject::FixLinearParam(i, TRUE, 0.);
  }


  m_Nx[0] = 1.;   m_Nx[1] = 0.;  m_Nx[2] = 0.;  // local X axis direction
  m_Ny[0] = 0.;   m_Ny[1] = 1.;  m_Ny[2] = 0.;  // local Y axis direction
  m_Nz[0] = 0.;   m_Nz[1] = 0.;  m_Nz[2] = 1.;  // local Z axis direction

  m_iIsFixedGradDirection = 0;
  m_lfNx = 0;
  m_lfNy = 0;
  m_lfNz = 1;
  m_lfSeparation = 1.;

}

CMagData::CMagData(FIELDTYPE type):CMagObject(0, MAX_FIELD_PARAMS, MAX_FIELD_PARAMS, "data") {

  m_iFieldType = type;


  for(int i=0; i< MAX_FIELD_PARAMS; i++)
    CMagObject::FixNonLinearParam(i, TRUE, 0.);

  m_Nx[0] = 1.;   m_Nx[1] = 0.;  m_Nx[2] = 0.;  // local X axis direction
  m_Ny[0] = 0.;   m_Ny[1] = 1.;  m_Ny[2] = 0.;  // local Y axis direction
  m_Nz[0] = 0.;   m_Nz[1] = 0.;  m_Nz[2] = 1.;  // local Z axis direction

  m_iIsFixedGradDirection = 0;
  m_lfNx = 0;
  m_lfNy = 0;
  m_lfNz = 1;
  m_lfSeparation = 1.;

}

CMagData::~CMagData() {

}


void CMagData::SetLocalSystem(double * nx, double * ny, double * nz) {

    int i;
    for(i=0; i<3; i++) {
	m_Nx[i] = nx[i];
	m_Ny[i] = ny[i];
	m_Nz[i] = nz[i];
    }

}


int CMagData::GetAllPositionParams(double * params,    int size) {

  if(!m_lfPos && !size) return 0;

  CMagObject::GetAllPositionParams(params, size);

  if(size >= 3) {
      params[0] = m_lfPos[0]*m_Nx[0] +  m_lfPos[1]*m_Ny[0] + m_lfPos[2]*m_Nz[0];
      params[1] = m_lfPos[0]*m_Nx[1] +  m_lfPos[1]*m_Ny[1] + m_lfPos[2]*m_Nz[1];
      params[2] = m_lfPos[0]*m_Nx[2] +  m_lfPos[1]*m_Ny[2] + m_lfPos[2]*m_Nz[2];
  }

  if(size>= FINITE_SEPARATION) {
	  params[DIRECTION_X]       = m_lfNx;
	  params[DIRECTION_Y]       = m_lfNy;
	  params[DIRECTION_Z]       = m_lfNz;
	  params[FINITE_SEPARATION] = m_lfSeparation;
  }


  return 1;
}

void CMagData::RecomputeIntoGlobal(double *x) {

    double params[3];

   params[0] = x[0]*m_Nx[0] +  x[1]*m_Ny[0] + x[2]*m_Nz[0];
   params[1] = x[0]*m_Nx[1] +  x[1]*m_Ny[1] + x[2]*m_Nz[1];
   params[2] = x[0]*m_Nx[2] +  x[1]*m_Ny[2] + x[2]*m_Nz[2];

   for(int i=0; i<3; i++) x[i] = params[i];

}


int CMagData::GetNonLinearDerivatives(FIELDTYPE type, double * add_params, double * deriv, int size,
				      double * pos_deriv,
				      double x_obs, double y_obs, double z_obs,
				      double x0,    double y0,    double z0,
				      double A,     double B,     double C,
				      int data_pos, int * n_params, int * start) {

  int i, j;

  double deriv_local[3];

  deriv_local[0] = pos_deriv[0]*m_Nx[0] + pos_deriv[1]*m_Nx[1] + pos_deriv[2]*m_Nx[2];
  deriv_local[1] = pos_deriv[0]*m_Ny[0] + pos_deriv[1]*m_Ny[1] + pos_deriv[2]*m_Ny[2];
  deriv_local[2] = pos_deriv[0]*m_Nz[0] + pos_deriv[1]*m_Nz[1] + pos_deriv[2]*m_Nz[2];

 if(start) *start =  m_iNonLinearStart;

  j=0;
  *n_params = 0;
  for(i=0; i<3; i++) {
	  if(!m_pPosfixed[i]) {
	    deriv[j] = -deriv_local[i];
	    j++;
	    (*n_params)++;
	  }
	}

  return 1;
}


int CMagData::SetFixedDirection(double nx, double ny, double nz) {

  double s = nx*nx + ny*ny + nz*nz;
  if(s == 0.) return 0;

  s = sqrt(s);

  nx /= s; ny /=s; nz /=s;

  m_lfNx = nx;
  m_lfNy = ny;
  m_lfNz = nz;

  m_iIsFixedGradDirection = 1;
  return 1;

}