2 * This file is part of the GROMACS molecular simulation package.
4 * Copyright (c) 1991-2000, University of Groningen, The Netherlands.
5 * Copyright (c) 2001-2004, The GROMACS development team.
6 * Copyright (c) 2010,2014, by the GROMACS development team, led by
7 * Mark Abraham, David van der Spoel, Berk Hess, and Erik Lindahl,
8 * and including many others, as listed in the AUTHORS file in the
9 * top-level source directory and at http://www.gromacs.org.
11 * GROMACS is free software; you can redistribute it and/or
12 * modify it under the terms of the GNU Lesser General Public License
13 * as published by the Free Software Foundation; either version 2.1
14 * of the License, or (at your option) any later version.
16 * GROMACS is distributed in the hope that it will be useful,
17 * but WITHOUT ANY WARRANTY; without even the implied warranty of
18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
19 * Lesser General Public License for more details.
21 * You should have received a copy of the GNU Lesser General Public
22 * License along with GROMACS; if not, see
23 * http://www.gnu.org/licenses, or write to the Free Software Foundation,
24 * Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
26 * If you want to redistribute modifications to GROMACS, please
27 * consider that scientific software is very special. Version
28 * control is crucial - bugs must be traceable. We will be happy to
29 * consider code for inclusion in the official distribution, but
30 * derived work must not be called official GROMACS. Details are found
31 * in the README & COPYING files - if they are missing, get the
32 * official version at http://www.gromacs.org.
34 * To help us fund GROMACS development, we humbly ask that you cite
35 * the research papers on the package. Check out http://www.gromacs.org.
37 #include "gromacs/math/3dview.h"
44 #include "gromacs/utility/smalloc.h"
48 #include "gromacs/math/vec.h"
50 #include "gromacs/utility/fatalerror.h"
54 void m4_op(mat4 m, rvec x, vec4 v)
58 for (i = 0; (i < N); i++)
60 v[i] = m[XX][i]*x[XX]+m[YY][i]*x[YY]+m[ZZ][i]*x[ZZ]+m[WW][i];
68 for (i = 0; (i < N); i++)
70 for (j = 0; (j < N); j++)
84 void print_m4(FILE *fp, const char *s, mat4 A)
90 fprintf(fp, "%s: ", s);
91 for (i = 0; i < N; i++)
94 for (j = 0; j < N; j++)
96 fprintf(fp, "%10.5f", A[i][j]);
103 void print_v4(FILE *fp, char *s, int dim, real *a)
109 fprintf(fp, "%s: ", s);
110 for (j = 0; j < dim; j++)
112 fprintf(fp, "%10.5f", a[j]);
118 void mult_matrix(mat4 A, mat4 B, mat4 C)
122 for (i = 0; i < N; i++)
124 for (j = 0; j < N; j++)
127 for (k = 0; (k < N); k++)
129 A[i][j] += B[i][k]*C[k][j];
135 void rotate(int axis, real angle, mat4 A)
142 A[YY][YY] = cos(angle);
143 A[YY][ZZ] = -sin(angle);
144 A[ZZ][YY] = sin(angle);
145 A[ZZ][ZZ] = cos(angle);
148 A[XX][XX] = cos(angle);
149 A[XX][ZZ] = sin(angle);
150 A[ZZ][XX] = -sin(angle);
151 A[ZZ][ZZ] = cos(angle);
154 A[XX][XX] = cos(angle);
155 A[XX][YY] = -sin(angle);
156 A[YY][XX] = sin(angle);
157 A[YY][YY] = cos(angle);
160 gmx_fatal(FARGS, "Error: invalid axis: %d", axis);
164 void translate(real tx, real ty, real tz, mat4 A)
172 static void set_scale(t_3dview *view, real sx, real sy)
178 void calculate_view(t_3dview *view)
181 mat4 To, Te, T1, T2, T3, T4, T5, N1, D1, D2, D3, D4, D5;
182 real dx, dy, dz, l, r;
188 l = sqrt(dx*dx+dy*dy+dz*dz);
189 r = sqrt(dx*dx+dy*dy);
191 print_v4(debug, "eye", N, view->eye);
192 printf("del: %10.5f%10.5f%10.5f l: %10.5f, r: %10.5f\n", dx, dy, dz, l, r);
196 gmx_fatal(FARGS, "Error: Zero Length Vector - No View Specified");
198 translate((real)(-view->origin[XX]),
199 (real)(-view->origin[YY]), (real)(-view->origin[ZZ]), To);
200 translate((real)(-view->eye[XX]),
201 (real)(-view->eye[YY]), (real)(-view->eye[ZZ]), Te);
204 T2[YY][YY] = 0, T2[YY][ZZ] = -1, T2[ZZ][YY] = 1, T2[ZZ][ZZ] = 0;
209 T3[XX][XX] = -dy/r, T3[XX][ZZ] = dx/r, T3[ZZ][XX] = -dx/r, T3[ZZ][ZZ] = -dy/r;
213 T4[YY][YY] = r/l, T4[YY][ZZ] = dz/l, T4[ZZ][YY] = -dz/l, T4[ZZ][ZZ] = r/l;
219 /* N1[XX][XX]=4,N1[YY][YY]=4; */
221 mult_matrix(T1, To, view->Rot);
222 mult_matrix(D1, Te, T2);
223 mult_matrix(D2, T3, T4);
224 mult_matrix(D3, T5, N1);
225 mult_matrix(D4, T1, D1);
226 mult_matrix(D5, D2, D3);
228 mult_matrix(view->proj, D4, D5);
231 print_m4(debug, "T1", T1);
232 print_m4(debug, "T2", T2);
233 print_m4(debug, "T3", T3);
234 print_m4(debug, "T4", T4);
235 print_m4(debug, "T5", T5);
236 print_m4(debug, "N1", N1);
237 print_m4(debug, "Rot", view->Rot);
238 print_m4(debug, "Proj", view->proj);
242 gmx_bool zoom_3d(t_3dview *view, real fac)
249 for (i = 0; (i < DIM); i++)
257 bm = max(norm(view->box[XX]), max(norm(view->box[YY]), norm(view->box[ZZ])));
258 if (dr1*fac < 1.1*bm) /* Don't come to close */
264 for (i = 0; (i < DIM); i++)
268 calculate_view(view);
272 void init_rotate_3d(t_3dview *view)
274 real rot = DEG2RAD*15;
277 for (i = 0; (i < DIM); i++)
279 rotate(i, rot, view->RotP[i]);
280 rotate(i, (real)(-rot), view->RotM[i]);
282 print_m4(debug, "RotP", view->RotP[i]);
283 print_m4(debug, "RotM", view->RotM[i]);
289 void rotate_3d(t_3dview *view, int axis, gmx_bool bPositive)
296 mult_matrix(m4, view->Rot, view->RotP[axis]);
300 mult_matrix(m4, view->Rot, view->RotM[axis]);
302 for (i = 0; (i < N); i++)
304 for (j = 0; (j < N); j++)
306 view->Rot[i][j] = m4[i][j];
310 calculate_view(view);
313 void translate_view(t_3dview *view, int axis, gmx_bool bPositive)
316 printf("Translate called\n");
320 view->origin[axis] += view->box[axis][axis]/8;
324 view->origin[axis] -= view->box[axis][axis]/8;
326 calculate_view(view);
329 void reset_view(t_3dview *view)
334 printf("Reset view called\n");
336 set_scale(view, 4.0, 4.0);
337 clear_rvec(view->eye);
338 calc_box_center(view->ecenter, view->box, view->origin);
339 view->eye[ZZ] = 3.0*max(view->box[XX][XX], view->box[YY][YY]);
341 view->eye[WW] = view->origin[WW] = 0.0;
343 /* Initiate the matrix */
345 calculate_view(view);
347 init_rotate_3d(view);
350 t_3dview *init_view(matrix box)
357 /* Copy parameters into variables */
358 for (i = 0; (i < DIM); i++)
360 for (j = 0; (j < DIM); j++)
362 view->box[i][j] = box[i][j];
366 view->ecenter = ecenterDEF;