more updates -> testing
[physik/posic.git] / moldyn.c
1 /*
2  * moldyn.c - molecular dynamics library main file
3  *
4  * author: Frank Zirkelbach <frank.zirkelbach@physik.uni-augsburg.de>
5  *
6  */
7
8 #define _GNU_SOURCE
9 #include <stdio.h>
10 #include <stdlib.h>
11 #include <string.h>
12 #include <sys/types.h>
13 #include <sys/stat.h>
14 #include <fcntl.h>
15 #include <unistd.h>
16 #include <math.h>
17
18 #include "moldyn.h"
19
20 #include "math/math.h"
21 #include "init/init.h"
22 #include "random/random.h"
23 #include "visual/visual.h"
24 #include "list/list.h"
25
26
27 int moldyn_init(t_moldyn *moldyn,int argc,char **argv) {
28
29         //int ret;
30
31         //ret=moldyn_parse_argv(moldyn,argc,argv);
32         //if(ret<0) return ret;
33
34         memset(moldyn,0,sizeof(t_moldyn));
35
36         rand_init(&(moldyn->random),NULL,1);
37         moldyn->random.status|=RAND_STAT_VERBOSE;
38
39         return 0;
40 }
41
42 int moldyn_shutdown(t_moldyn *moldyn) {
43
44         moldyn_log_shutdown(moldyn);
45         link_cell_shutdown(moldyn);
46         moldyn_log_shutdown(moldyn);
47         rand_close(&(moldyn->random));
48         free(moldyn->atom);
49
50         return 0;
51 }
52
53 int set_int_alg(t_moldyn *moldyn,u8 algo) {
54
55         switch(algo) {
56                 case MOLDYN_INTEGRATE_VERLET:
57                         moldyn->integrate=velocity_verlet;
58                         break;
59                 default:
60                         printf("unknown integration algorithm: %02x\n",algo);
61                         return -1;
62         }
63
64         return 0;
65 }
66
67 int set_cutoff(t_moldyn *moldyn,double cutoff) {
68
69         moldyn->cutoff=cutoff;
70
71         return 0;
72 }
73
74 int set_temperature(t_moldyn *moldyn,double t) {
75         
76         moldyn->t=t;
77
78         return 0;
79 }
80
81 int set_dim(t_moldyn *moldyn,double x,double y,double z,u8 visualize) {
82
83         moldyn->dim.x=x;
84         moldyn->dim.y=y;
85         moldyn->dim.z=z;
86
87         if(visualize) {
88                 moldyn->vis.dim.x=x;
89                 moldyn->vis.dim.y=y;
90                 moldyn->vis.dim.z=z;
91         }
92
93         return 0;
94 }
95
96 int set_pbc(t_moldyn *moldyn,u8 x,u8 y,u8 z) {
97
98         if(x)
99                 moldyn->status|=MOLDYN_STAT_PBX;
100
101         if(y)
102                 moldyn->status|=MOLDYN_STAT_PBY;
103
104         if(z)
105                 moldyn->status|=MOLDYN_STAT_PBZ;
106
107         return 0;
108 }
109
110 int set_potential1b(t_moldyn *moldyn,pf_func1b func,void *params) {
111
112         moldyn->func1b=func;
113         moldyn->pot1b_params=params;
114
115         return 0;
116 }
117
118 int set_potential2b(t_moldyn *moldyn,pf_func2b func,void *params) {
119
120         moldyn->func2b=func;
121         moldyn->pot2b_params=params;
122
123         return 0;
124 }
125
126 int set_potential3b(t_moldyn *moldyn,pf_func3b func,void *params) {
127
128         moldyn->func3b=func;
129         moldyn->pot3b_params=params;
130
131         return 0;
132 }
133
134 int moldyn_set_log(t_moldyn *moldyn,u8 type,char *fb,int timer) {
135
136         switch(type) {
137                 case LOG_TOTAL_ENERGY:
138                         moldyn->ewrite=timer;
139                         moldyn->efd=open(fb,O_WRONLY|O_CREAT|O_TRUNC);
140                         if(moldyn->efd<0) {
141                                 perror("[moldyn] efd open");
142                                 return moldyn->efd;
143                         }
144                         dprintf(moldyn->efd,"# total energy log file\n");
145                         break;
146                 case LOG_TOTAL_MOMENTUM:
147                         moldyn->mwrite=timer;
148                         moldyn->mfd=open(fb,O_WRONLY|O_CREAT|O_TRUNC);
149                         if(moldyn->mfd<0) {
150                                 perror("[moldyn] mfd open");
151                                 return moldyn->mfd;
152                         }
153                         dprintf(moldyn->efd,"# total momentum log file\n");
154                         break;
155                 case SAVE_STEP:
156                         moldyn->swrite=timer;
157                         strncpy(moldyn->sfb,fb,63);
158                         break;
159                 case VISUAL_STEP:
160                         moldyn->vwrite=timer;
161                         strncpy(moldyn->vfb,fb,63);
162                         visual_init(&(moldyn->vis),fb);
163                         break;
164                 default:
165                         printf("unknown log mechanism: %02x\n",type);
166                         return -1;
167         }
168
169         return 0;
170 }
171
172 int moldyn_log_shutdown(t_moldyn *moldyn) {
173
174         if(moldyn->efd) close(moldyn->efd);
175         if(moldyn->mfd) close(moldyn->mfd);
176         if(moldyn->visual) visual_tini(moldyn->visual);
177
178         return 0;
179 }
180
181 int create_lattice(t_moldyn *moldyn,u8 type,double lc,int element,double mass,
182                    u8 attr,u8 bnum,int a,int b,int c) {
183
184         int count;
185         int ret;
186         t_3dvec origin;
187         t_atom *atom;
188
189         count=a*b*c;
190         atom=moldyn->atom;
191
192         if(type==FCC) count*=4;
193
194         if(type==DIAMOND) count*=8;
195
196         atom=malloc(count*sizeof(t_atom));
197         if(atom==NULL) {
198                 perror("malloc (atoms)");
199                 return -1;
200         }
201
202         v3_zero(&origin);
203
204         switch(type) {
205                 case FCC:
206                         ret=fcc_init(a,b,c,lc,atom,&origin);
207                         break;
208                 case DIAMOND:
209                         ret=diamond_init(a,b,c,lc,atom,&origin);
210                         break;
211                 default:
212                         printf("unknown lattice type (%02x)\n",type);
213                         return -1;
214         }
215
216         /* debug */
217         if(ret!=count) {
218                 printf("ok, there is something wrong ...\n");
219                 printf("calculated -> %d atoms\n",count);
220                 printf("created -> %d atoms\n",ret);
221                 return -1;
222         }
223
224         moldyn->count=count;
225
226         while(count) {
227                 atom[count-1].element=element;
228                 atom[count-1].mass=mass;
229                 atom[count-1].attr=attr;
230                 atom[count-1].bnum=bnum;
231                 count-=1;
232         }
233
234         return ret;
235 }
236
237 int add_atom(t_moldyn *moldyn,int element,double mass,u8 bnum,u8 attr,
238              t_3dvec *r,t_3dvec *v) {
239
240         t_atom *atom;
241         void *ptr;
242         int count;
243         
244         atom=moldyn->atom;
245         count=++(moldyn->count);
246
247         ptr=realloc(atom,count*sizeof(t_atom));
248         if(!ptr) {
249                 perror("[moldyn] realloc (add atom)");
250                 return -1;
251         }
252         moldyn->atom=ptr;
253
254         atom=moldyn->atom;
255         atom[count-1].r=*r;
256         atom[count-1].v=*v;
257         atom[count-1].element=element;
258         atom[count-1].mass=mass;
259         atom[count-1].bnum=bnum;
260         atom[count-1].attr=attr;
261
262         return 0;
263 }
264
265 int destroy_atoms(t_moldyn *moldyn) {
266
267         if(moldyn->atom) free(moldyn->atom);
268
269         return 0;
270 }
271
272 int thermal_init(t_moldyn *moldyn) {
273
274         /*
275          * - gaussian distribution of velocities
276          * - zero total momentum
277          * - velocity scaling (E = 3/2 N k T), E: kinetic energy
278          */
279
280         int i;
281         double v,sigma;
282         t_3dvec p_total,delta;
283         t_atom *atom;
284         t_random *random;
285
286         atom=moldyn->atom;
287         random=&(moldyn->random);
288
289         /* gaussian distribution of velocities */
290         v3_zero(&p_total);
291         for(i=0;i<moldyn->count;i++) {
292                 sigma=sqrt(2.0*K_BOLTZMANN*moldyn->t/atom[i].mass);
293                 /* x direction */
294                 v=sigma*rand_get_gauss(random);
295                 atom[i].v.x=v;
296                 p_total.x+=atom[i].mass*v;
297                 /* y direction */
298                 v=sigma*rand_get_gauss(random);
299                 atom[i].v.y=v;
300                 p_total.y+=atom[i].mass*v;
301                 /* z direction */
302                 v=sigma*rand_get_gauss(random);
303                 atom[i].v.z=v;
304                 p_total.z+=atom[i].mass*v;
305         }
306
307         /* zero total momentum */
308         v3_scale(&p_total,&p_total,1.0/moldyn->count);
309         for(i=0;i<moldyn->count;i++) {
310                 v3_scale(&delta,&p_total,1.0/atom[i].mass);
311                 v3_sub(&(atom[i].v),&(atom[i].v),&delta);
312         }
313
314         /* velocity scaling */
315         scale_velocity(moldyn);
316
317         return 0;
318 }
319
320 int scale_velocity(t_moldyn *moldyn) {
321
322         int i;
323         double e,c;
324         t_atom *atom;
325
326         atom=moldyn->atom;
327
328         /*
329          * - velocity scaling (E = 3/2 N k T), E: kinetic energy
330          */
331
332         if(moldyn->t==0.0) {
333                 printf("[moldyn] no velocity scaling for T = 0 K\n");
334                 return -1;
335         }
336
337         e=0.0;
338         for(i=0;i<moldyn->count;i++)
339                 e+=0.5*atom[i].mass*v3_absolute_square(&(atom[i].v));
340         c=sqrt((2.0*e)/(3.0*moldyn->count*K_BOLTZMANN*moldyn->t));
341         for(i=0;i<moldyn->count;i++)
342                 v3_scale(&(atom[i].v),&(atom[i].v),(1.0/c));
343
344         return 0;
345 }
346
347 double get_e_kin(t_moldyn *moldyn) {
348
349         int i;
350         t_atom *atom;
351
352         atom=moldyn->atom;
353         moldyn->ekin=0.0;
354
355         for(i=0;i<moldyn->count;i++)
356                 moldyn->ekin+=0.5*atom[i].mass*v3_absolute_square(&(atom[i].v));
357
358         return moldyn->ekin;
359 }
360
361 double get_e_pot(t_moldyn *moldyn) {
362
363         return moldyn->energy;
364 }
365
366 double update_e_kin(t_moldyn *moldyn) {
367
368         return(get_e_kin(moldyn));
369 }
370
371 double get_total_energy(t_moldyn *moldyn) {
372
373         return(moldyn->ekin+moldyn->energy);
374 }
375
376 t_3dvec get_total_p(t_moldyn *moldyn) {
377
378         t_3dvec p,p_total;
379         int i;
380         t_atom *atom;
381
382         atom=moldyn->atom;
383
384         v3_zero(&p_total);
385         for(i=0;i<moldyn->count;i++) {
386                 v3_scale(&p,&(atom[i].v),atom[i].mass);
387                 v3_add(&p_total,&p_total,&p);
388         }
389
390         return p_total;
391 }
392
393 double estimate_time_step(t_moldyn *moldyn,double nn_dist) {
394
395         double tau;
396
397         /* nn_dist is the nearest neighbour distance */
398
399         if(moldyn->t==5.0) {
400                 printf("[moldyn] i do not estimate timesteps below %f K!\n",
401                        MOLDYN_CRITICAL_EST_TEMP);
402                 return 23.42;
403         }
404
405         tau=(0.05*nn_dist*moldyn->atom[0].mass)/sqrt(3.0*K_BOLTZMANN*moldyn->t);
406
407         return tau;     
408 }
409
410 /*
411  * numerical tricks
412  */
413
414 /* linked list / cell method */
415
416 int link_cell_init(t_moldyn *moldyn) {
417
418         t_linkcell *lc;
419         int i;
420         int fd;
421
422         fd=open("/dev/null",O_WRONLY);
423
424         lc=&(moldyn->lc);
425
426         /* partitioning the md cell */
427         lc->nx=moldyn->dim.x/moldyn->cutoff;
428         lc->x=moldyn->dim.x/lc->nx;
429         lc->ny=moldyn->dim.y/moldyn->cutoff;
430         lc->y=moldyn->dim.y/lc->ny;
431         lc->nz=moldyn->dim.z/moldyn->cutoff;
432         lc->z=moldyn->dim.z/lc->nz;
433
434         lc->cells=lc->nx*lc->ny*lc->nz;
435         lc->subcell=malloc(lc->cells*sizeof(t_list));
436
437         printf("[moldyn] initializing linked cells (%d)\n",lc->cells);
438
439         for(i=0;i<lc->cells;i++)
440                 //list_init(&(lc->subcell[i]),1);
441                 list_init(&(lc->subcell[i]),fd);
442
443         link_cell_update(moldyn);
444         
445         return 0;
446 }
447
448 int link_cell_update(t_moldyn *moldyn) {
449
450         int count,i,j,k;
451         int nx,ny,nz;
452         t_atom *atom;
453         t_linkcell *lc;
454
455         atom=moldyn->atom;
456         lc=&(moldyn->lc);
457
458         nx=lc->nx;
459         ny=lc->ny;
460         nz=lc->nz;
461
462         for(i=0;i<lc->cells;i++)
463                 list_destroy(&(moldyn->lc.subcell[i]));
464         
465         for(count=0;count<moldyn->count;count++) {
466                 i=(atom[count].r.x+(moldyn->dim.x/2))/lc->x;
467                 j=(atom[count].r.y+(moldyn->dim.y/2))/lc->y;
468                 k=(atom[count].r.z+(moldyn->dim.z/2))/lc->z;
469                 list_add_immediate_ptr(&(moldyn->lc.subcell[i+j*nx+k*nx*ny]),
470                                        &(atom[count]));
471         }
472
473         return 0;
474 }
475
476 int link_cell_neighbour_index(t_moldyn *moldyn,int i,int j,int k,t_list *cell) {
477
478         t_linkcell *lc;
479         int a;
480         int count1,count2;
481         int ci,cj,ck;
482         int nx,ny,nz;
483         int x,y,z;
484         u8 bx,by,bz;
485
486         lc=&(moldyn->lc);
487         nx=lc->nx;
488         ny=lc->ny;
489         nz=lc->nz;
490         count1=1;
491         count2=27;
492         a=nx*ny;
493
494
495         cell[0]=lc->subcell[i+j*nx+k*a];
496         for(ci=-1;ci<=1;ci++) {
497                 bx=0;
498                 x=i+ci;
499                 if((x<0)||(x>=nx)) {
500                         x=(x+nx)%nx;
501                         bx=1;
502                 }
503                 for(cj=-1;cj<=1;cj++) {
504                         by=0;
505                         y=j+cj;
506                         if((y<0)||(y>=ny)) {
507                                 y=(y+ny)%ny;
508                                 by=1;
509                         }
510                         for(ck=-1;ck<=1;ck++) {
511                                 bz=0;
512                                 z=k+ck;
513                                 if((z<0)||(z>=nz)) {
514                                         z=(z+nz)%nz;
515                                         bz=1;
516                                 }
517                                 if(!(ci|cj|ck)) continue;
518                                 if(bx|by|bz) {
519                                         cell[--count2]=lc->subcell[x+y*nx+z*a];
520                                 }
521                                 else {
522                                         cell[count1++]=lc->subcell[x+y*nx+z*a];
523                                 }
524                         }
525                 }
526         }
527
528         lc->dnlc=count2;
529         lc->countn=27;
530
531         return count2;
532 }
533
534 int link_cell_shutdown(t_moldyn *moldyn) {
535
536         int i;
537         t_linkcell *lc;
538
539         lc=&(moldyn->lc);
540
541         for(i=0;i<lc->nx*lc->ny*lc->nz;i++)
542                 list_shutdown(&(moldyn->lc.subcell[i]));
543
544         return 0;
545 }
546
547 int moldyn_add_schedule(t_moldyn *moldyn,int runs,double tau) {
548
549         int count;
550         void *ptr;
551         t_moldyn_schedule *schedule;
552
553         schedule=&(moldyn->schedule);
554         count=++(schedule->content_count);
555
556         ptr=realloc(moldyn->schedule.runs,count*sizeof(int));
557         if(!ptr) {
558                 perror("[moldyn] realloc (runs)");
559                 return -1;
560         }
561         moldyn->schedule.runs=ptr;
562         moldyn->schedule.runs[count-1]=runs;
563
564         ptr=realloc(schedule->tau,count*sizeof(double));
565         if(!ptr) {
566                 perror("[moldyn] realloc (tau)");
567                 return -1;
568         }
569         moldyn->schedule.tau=ptr;
570         moldyn->schedule.tau[count-1]=tau;
571
572         return 0;
573 }
574
575 int moldyn_set_schedule_hook(t_moldyn *moldyn,void *hook,void *hook_params) {
576
577         moldyn->schedule.hook=hook;
578         moldyn->schedule.hook_params=hook_params;
579         
580         return 0;
581 }
582
583 /*
584  *
585  * 'integration of newtons equation' - algorithms
586  *
587  */
588
589 /* start the integration */
590
591 int moldyn_integrate(t_moldyn *moldyn) {
592
593         int i,sched;
594         unsigned int e,m,s,v;
595         t_3dvec p;
596         t_moldyn_schedule *schedule;
597         t_atom *atom;
598
599         int fd;
600         char fb[128];
601
602         schedule=&(moldyn->schedule);
603         atom=moldyn->atom;
604
605         /* initialize linked cell method */
606         link_cell_init(moldyn);
607
608         /* logging & visualization */
609         e=moldyn->ewrite;
610         m=moldyn->mwrite;
611         s=moldyn->swrite;
612         v=moldyn->vwrite;
613
614         /* sqaure of some variables */
615         moldyn->tau_square=moldyn->tau*moldyn->tau;
616         moldyn->cutoff_square=moldyn->cutoff*moldyn->cutoff;
617
618         /* calculate initial forces */
619         potential_force_calc(moldyn);
620
621         /* zero absolute time */
622         moldyn->time=0.0;
623
624         for(sched=0;sched<moldyn->schedule.content_count;sched++) {
625
626                 /* setting amount of runs and finite time step size */
627                 moldyn->tau=schedule->tau[sched];
628                 moldyn->tau_square=moldyn->tau*moldyn->tau;
629                 moldyn->time_steps=schedule->runs[sched];
630
631         /* integration according to schedule */
632
633         for(i=0;i<moldyn->time_steps;i++) {
634
635                 /* integration step */
636                 moldyn->integrate(moldyn);
637
638                 /* increase absolute time */
639                 moldyn->time+=moldyn->tau;
640
641                 /* check for log & visualization */
642                 if(e) {
643                         if(!(i%e))
644                                 dprintf(moldyn->efd,
645                                         "%.15f %.45f %.45f %.45f\n",
646                                         moldyn->time,update_e_kin(moldyn),
647                                         moldyn->energy,
648                                         get_total_energy(moldyn));
649                 }
650                 if(m) {
651                         if(!(i%m)) {
652                                 p=get_total_p(moldyn);
653                                 dprintf(moldyn->mfd,
654                                         "%.15f %.45f\n",moldyn->time,
655                                         v3_norm(&p));
656                         }
657                 }
658                 if(s) {
659                         if(!(i%s)) {
660                                 snprintf(fb,128,"%s-%f-%.15f.save",moldyn->sfb,
661                                          moldyn->t,i*moldyn->tau);
662                                 fd=open(fb,O_WRONLY|O_TRUNC|O_CREAT);
663                                 if(fd<0) perror("[moldyn] save fd open");
664                                 else {
665                                         write(fd,moldyn,sizeof(t_moldyn));
666                                         write(fd,moldyn->atom,
667                                               moldyn->count*sizeof(t_atom));
668                                 }
669                                 close(fd);
670                         }       
671                 }
672                 if(v) {
673                         if(!(i%v)) {
674                                 visual_atoms(&(moldyn->vis),moldyn->time,
675                                              moldyn->atom,moldyn->count);
676                                 printf("\rsched: %d, steps: %d",sched,i);
677                                 fflush(stdout);
678                         }
679                 }
680
681         }
682
683                 /* check for hooks */
684                 if(schedule->hook)
685                         schedule->hook(moldyn,schedule->hook_params);
686
687         }
688
689         return 0;
690 }
691
692 /* velocity verlet */
693
694 int velocity_verlet(t_moldyn *moldyn) {
695
696         int i,count;
697         double tau,tau_square;
698         t_3dvec delta;
699         t_atom *atom;
700
701         atom=moldyn->atom;
702         count=moldyn->count;
703         tau=moldyn->tau;
704         tau_square=moldyn->tau_square;
705
706         for(i=0;i<count;i++) {
707                 /* new positions */
708                 v3_scale(&delta,&(atom[i].v),tau);
709                 v3_add(&(atom[i].r),&(atom[i].r),&delta);
710                 v3_scale(&delta,&(atom[i].f),0.5*tau_square/atom[i].mass);
711                 v3_add(&(atom[i].r),&(atom[i].r),&delta);
712                 check_per_bound(moldyn,&(atom[i].r));
713
714                 /* velocities */
715                 v3_scale(&delta,&(atom[i].f),0.5*tau/atom[i].mass);
716                 v3_add(&(atom[i].v),&(atom[i].v),&delta);
717         }
718
719         /* neighbour list update */
720         link_cell_update(moldyn);
721
722         /* forces depending on chosen potential */
723         potential_force_calc(moldyn);
724         //moldyn->potential_force_function(moldyn);
725
726         for(i=0;i<count;i++) {
727                 /* again velocities */
728                 v3_scale(&delta,&(atom[i].f),0.5*tau/atom[i].mass);
729                 v3_add(&(atom[i].v),&(atom[i].v),&delta);
730         }
731
732         return 0;
733 }
734
735
736 /*
737  *
738  * potentials & corresponding forces
739  * 
740  */
741
742 /* generic potential and force calculation */
743
744 int potential_force_calc(t_moldyn *moldyn) {
745
746         int i,j,k,count;
747         t_atom *atom,*btom,*ktom;
748         t_linkcell *lc;
749         t_list neighbour[27];
750         t_list *this,*thisk,*neighbourk;
751         u8 bc,bck;
752         int countn,dnlc;
753
754         count=moldyn->count;
755         atom=moldyn->atom;
756         lc=&(moldyn->lc);
757
758         /* reset energy */
759         moldyn->energy=0.0;
760
761         for(i=0;i<count;i++) {
762         
763                 /* reset force */
764                 v3_zero(&(atom[i].f));
765
766                 /* single particle potential/force */
767                 if(atom[i].attr&ATOM_ATTR_1BP)
768                         moldyn->func1b(moldyn,&(atom[i]));
769
770                 /* 2 body pair potential/force */
771                 if(atom[i].attr&(ATOM_ATTR_2BP|ATOM_ATTR_3BP)) {
772         
773                         link_cell_neighbour_index(moldyn,
774                                 (atom[i].r.x+moldyn->dim.x/2)/lc->x,
775                                 (atom[i].r.y+moldyn->dim.y/2)/lc->y,
776                                 (atom[i].r.z+moldyn->dim.z/2)/lc->z,
777                                 neighbour);
778
779                         countn=lc->countn;
780                         dnlc=lc->dnlc;
781
782                         for(j=0;j<countn;j++) {
783
784                                 this=&(neighbour[j]);
785                                 list_reset(this);
786
787                                 if(this->start==NULL)
788                                         continue;
789
790                                 bc=(j<dnlc)?0:1;
791
792                                 do {
793                                         btom=this->current->data;
794
795                                         if(btom==&(atom[i]))
796                                                 continue;
797
798                                         if((btom->attr&ATOM_ATTR_2BP)&
799                                            (atom[i].attr&ATOM_ATTR_2BP))
800                                                 moldyn->func2b(moldyn,
801                                                                &(atom[i]),
802                                                                btom,
803                                                                bc);
804
805                                         /* 3 body potential/force */
806
807                                         if(!(atom[i].attr&ATOM_ATTR_3BP)||
808                                            !(btom->attr&ATOM_ATTR_3BP))
809                                                 continue;
810
811                                         link_cell_neighbour_index(moldyn,
812                                            (btom->r.x+moldyn->dim.x/2)/lc->x,
813                                            (btom->r.y+moldyn->dim.y/2)/lc->y,
814                                            (btom->r.z+moldyn->dim.z/2)/lc->z,
815                                            neighbourk);
816
817                                         for(k=0;k<lc->countn;k++) {
818
819                                                 thisk=&(neighbourk[k]);
820                                                 list_reset(thisk);
821                                         
822                                                 if(thisk->start==NULL)
823                                                         continue;
824
825                                                 bck=(k<lc->dnlc)?0:1;
826
827                                                 do {
828
829                         ktom=thisk->current->data;
830
831                         if(!(ktom->attr&ATOM_ATTR_3BP))
832                                 continue;
833
834                         if(ktom==btom)
835                                 continue;
836
837                         if(ktom==&(atom[i]))
838                                 continue;
839
840                         moldyn->func3b(moldyn,&(atom[i]),btom,ktom,bck);
841
842                                                 } while(list_next(thisk)!=\
843                                                         L_NO_NEXT_ELEMENT);
844
845                                         }
846                                         
847                                 } while(list_next(this)!=L_NO_NEXT_ELEMENT);
848                         }
849                 }
850         }
851
852         return 0;
853 }
854
855 /*
856  * periodic boundayr checking
857  */
858
859 int check_per_bound(t_moldyn *moldyn,t_3dvec *a) {
860         
861         double x,y,z;
862         t_3dvec *dim;
863
864         dim=&(moldyn->dim);
865
866         x=0.5*dim->x;
867         y=0.5*dim->y;
868         z=0.5*dim->z;
869
870         if(moldyn->status&MOLDYN_STAT_PBX) {
871                 if(a->x>=x) a->x-=dim->x;
872                 else if(-a->x>x) a->x+=dim->x;
873         }
874         if(moldyn->status&MOLDYN_STAT_PBY) {
875                 if(a->y>=y) a->y-=dim->y;
876                 else if(-a->y>y) a->y+=dim->y;
877         }
878         if(moldyn->status&MOLDYN_STAT_PBZ) {
879                 if(a->z>=z) a->z-=dim->z;
880                 else if(-a->z>z) a->z+=dim->z;
881         }
882
883         return 0;
884 }
885         
886
887 /*
888  * example potentials
889  */
890
891 /* harmonic oscillator potential and force */
892
893 int harmonic_oscillator(t_moldyn *moldyn,t_atom *ai,t_atom *aj,u8 bc) {
894
895         t_ho_params *params;
896         t_3dvec force,distance;
897         double d;
898         double sc,equi_dist;
899
900         params=moldyn->pot2b_params;
901         sc=params->spring_constant;
902         equi_dist=params->equilibrium_distance;
903
904         v3_sub(&distance,&(ai->r),&(aj->r));
905         
906         if(bc) check_per_bound(moldyn,&distance);
907         d=v3_norm(&distance);
908         if(d<=moldyn->cutoff) {
909                 /* energy is 1/2 (d-d0)^2, but we will add this twice ... */
910                 moldyn->energy+=(0.25*sc*(d-equi_dist)*(d-equi_dist));
911                 v3_scale(&force,&distance,-sc*(1.0-(equi_dist/d)));
912                 v3_add(&(ai->f),&(ai->f),&force);
913         }
914
915         return 0;
916 }
917
918 /* lennard jones potential & force for one sort of atoms */
919  
920 int lennard_jones(t_moldyn *moldyn,t_atom *ai,t_atom *aj,u8 bc) {
921
922         t_lj_params *params;
923         t_3dvec force,distance;
924         double d,h1,h2;
925         double eps,sig6,sig12;
926
927         params=moldyn->pot2b_params;
928         eps=params->epsilon4;
929         sig6=params->sigma6;
930         sig12=params->sigma12;
931
932         v3_sub(&distance,&(ai->r),&(aj->r));
933         if(bc) check_per_bound(moldyn,&distance);
934         d=v3_absolute_square(&distance);        /* 1/r^2 */
935         if(d<=moldyn->cutoff_square) {
936                 d=1.0/d;                        /* 1/r^2 */
937                 h2=d*d;                         /* 1/r^4 */
938                 h2*=d;                          /* 1/r^6 */
939                 h1=h2*h2;                       /* 1/r^12 */
940                 /* energy is eps*..., but we will add this twice ... */
941                 moldyn->energy+=0.5*eps*(sig12*h1-sig6*h2);
942                 h2*=d;                          /* 1/r^8 */
943                 h1*=d;                          /* 1/r^14 */
944                 h2*=6*sig6;
945                 h1*=12*sig12;
946                 d=+h1-h2;
947                 d*=eps;
948                 v3_scale(&force,&distance,d);
949                 v3_add(&(ai->f),&(ai->f),&force);
950         }
951
952         return 0;
953 }
954
955 /*
956  * tersoff potential & force for 2 sorts of atoms
957  */
958
959 /* tersoff 1 body part */
960 int tersoff_mult_1bp(t_moldyn *moldyn,t_atom *ai) {
961
962         int num;
963         t_tersoff_mult_params *params;
964         t_tersoff_exchange *exchange;
965         
966         num=ai->bnum;
967         params=moldyn->pot1b_params;
968         exchange=&(params->exchange);
969
970         /*
971          * simple: point constant parameters only depending on atom i to
972          *         their right values
973          */
974
975         exchange->beta=&(params->beta[num]);
976         exchange->n=&(params->n[num]);
977         exchange->c=&(params->c[num]);
978         exchange->d=&(params->d[num]);
979         exchange->h=&(params->h[num]);
980
981         exchange->betan=pow(*(exchange->beta),*(exchange->n));
982         exchange->c2=params->c[num]*params->c[num];
983         exchange->d2=params->d[num]*params->d[num];
984         exchange->c2d2=exchange->c2/exchange->d2;
985
986         return 0;
987 }
988         
989 /* tersoff 2 body part */
990 int tersoff_mult_2bp(t_moldyn *moldyn,t_atom *ai,t_atom *aj,u8 bc) {
991
992         t_tersoff_mult_params *params;
993         t_tersoff_exchange *exchange;
994         t_3dvec dist_ij,force;
995         double d_ij;
996         double A,B,R,S,lambda,mu;
997         double f_r,df_r;
998         double f_c,df_c;
999         int num;
1000         double s_r;
1001         double arg;
1002         double scale;
1003
1004         params=moldyn->pot2b_params;
1005         num=ai->bnum;
1006         exchange=&(params->exchange);
1007
1008         exchange->run3bp=0;
1009         
1010         /*
1011          * we need: f_c, df_c, f_r, df_r
1012          *
1013          * therefore we need: R, S, A, lambda
1014          */
1015
1016         v3_sub(&dist_ij,&(ai->r),&(aj->r));
1017
1018         if(bc) check_per_bound(moldyn,&dist_ij);
1019
1020         /* save for use in 3bp */ /* REALLY ?!?!?! */
1021         exchange->dist_ij=dist_ij;
1022
1023         /* constants */
1024         if(num==aj->bnum) {
1025                 S=params->S[num];
1026                 R=params->R[num];
1027                 A=params->A[num];
1028                 lambda=params->lambda[num];
1029                 /* more constants depending of atoms i and j, needed in 3bp */
1030                 params->exchange.B=&(params->B[num]);
1031                 params->exchange.mu=&(params->mu[num]);
1032                 mu=params->mu[num];
1033                 params->exchange.chi=1.0;
1034         }
1035         else {
1036                 S=params->Smixed;
1037                 R=params->Rmixed;
1038                 A=params->Amixed;
1039                 lambda=params->lambda_m;
1040                 /* more constants depending of atoms i and j, needed in 3bp */
1041                 params->exchange.B=&(params->Bmixed);
1042                 params->exchange.mu=&(params->mu_m);
1043                 mu=params->mu_m;
1044                 params->exchange.chi=params->chi;
1045         }
1046
1047         d_ij=v3_norm(&dist_ij);
1048
1049         /* save for use in 3bp */
1050         exchange->d_ij=d_ij;
1051
1052         if(d_ij>S)
1053                 return 0;
1054
1055         f_r=A*exp(-lambda*d_ij);
1056         df_r=-lambda*f_r/d_ij;
1057
1058         /* f_a, df_a calc + save for 3bp use */
1059         exchange->f_a=-B*exp(-mu*d_ij);
1060         exchange->df_a=-mu*exchange->f_a/d_ij;
1061
1062         if(d_ij<R) {
1063                 /* f_c = 1, df_c = 0 */
1064                 f_c=1.0;
1065                 df_c=0.0;
1066                 v3_scale(&force,&dist_ij,df_r);
1067         }
1068         else {
1069                 s_r=S-R;
1070                 arg=M_PI*(d_ij-R)/s_r;
1071                 f_c=0.5+0.5*cos(arg);
1072                 df_c=-0.5*sin(arg)*(M_PI/(s_r*d_ij));
1073                 scale=df_c*f_r+df_r*f_c;
1074                 v3_scale(&force,&dist_ij,scale);
1075         }
1076
1077         /* add forces */
1078         v3_add(&(ai->f),&(ai->f),&force);
1079         /* energy is 0.5 f_r f_c, but we will sum it up twice ... */
1080         moldyn->energy+=(0.25*f_r*f_c);
1081
1082         /* save for use in 3bp */
1083         exchange->f_c=f_c;
1084         exchange->df_c=df_c;
1085
1086         /* enable the run of 3bp function */
1087         exchange->run3bp=1;
1088
1089         return 0;
1090 }
1091
1092 /* tersoff 3 body part */
1093
1094 int tersoff_mult_3bp(t_moldyn *moldyn,t_atom *ai,t_atom *aj,t_atom *ak,u8 bc) {
1095
1096         t_tersoff_mult_params *params;
1097         t_tersoff_exchange *exchange;
1098         t_3dvec dist_ij,dist_ik,dist_jk;
1099         t_3dvec temp,force;
1100         double R,S,s_r;
1101         double d_ij,d_ij2,d_ik,d_jk;
1102         double f_c,df_c,b_ij,f_a,df_a;
1103         double f_c_ik,df_c_ik,arg;
1104         double scale;
1105         double chi;
1106         double n,c,d,h,beta,betan;
1107         double c2,d2,c2d2;
1108         double numer,denom;
1109         double theta,cos_theta,sin_theta;
1110         double d_theta,d_theta1,d_theta2;
1111         double h_cos,h_cos2,d2_h_cos2;
1112         double frac1,bracket1,bracket2,bracket2_n_1,bracket2_n;
1113         double bracket3,bracket3_pow_1,bracket3_pow;
1114         int num;
1115
1116         params=moldyn->pot3b_params;
1117         num=ai->bnum;
1118         exchange=&(params->exchange);
1119
1120         if(!(exchange->run3bp))
1121                 return 0;
1122
1123         /*
1124          * we need: f_c, d_fc, b_ij, db_ij, f_a, df_a
1125          *
1126          * we got f_c, df_c, f_a, df_a from 2bp calculation
1127          */
1128
1129         d_ij=exchange->d_ij;
1130         d_ij2=exchange->d_ij2;
1131
1132         f_a=params->exchange.f_a;
1133         df_a=params->exchange.df_a;
1134         
1135         /* d_ij is <= S, as we didn't return so far! */
1136
1137         /*
1138          * calc of b_ij (scalar) and db_ij (vector)
1139          *
1140          * - for b_ij: chi, beta, f_c_ik, w(=1), c, d, h, n, cos_theta
1141          *
1142          * - for db_ij: d_theta, sin_theta, cos_theta, f_c_ik, df_c_ik,
1143          *              w_ik,
1144          *
1145          */
1146
1147         
1148         v3_sub(&dist_ik,&(ai->r),&(ak->r));
1149         if(bc) check_per_bound(moldyn,&dist_ik);
1150         d_ik=v3_norm(&dist_ik);
1151
1152         /* constants for f_c_ik calc */
1153         if(num==ak->bnum) {
1154                 R=params->R[num];
1155                 S=params->S[num];
1156         }
1157         else {
1158                 R=params->Rmixed;
1159                 S=params->Smixed;
1160         }
1161
1162         /* calc of f_c_ik */
1163         if(d_ik>S)
1164                 return 0;
1165
1166         if(d_ik<R) {
1167                 /* f_c_ik = 1, df_c_ik = 0 */
1168                 f_c_ik=1.0;
1169                 df_c_ik=0.0;
1170         }
1171         else {
1172                 s_r=S-R;
1173                 arg=M_PI*(d_ik-R)/s_r;
1174                 f_c_ik=0.5+0.5*cos(arg);
1175                 df_c_ik=-0.5*sin(arg)*(M_PI/(s_r*d_ik));
1176         }
1177         
1178         v3_sub(&dist_jk,&(aj->r),&(ak->r));
1179         if(bc) check_per_bound(moldyn,&dist_jk);
1180         d_jk=v3_norm(&dist_jk);
1181
1182         beta=*(exchange->beta);
1183         betan=exchange->betan;
1184         n=*(exchange->n);
1185         c=*(exchange->c);
1186         d=*(exchange->d);
1187         h=*(exchange->h);
1188         c2=exchange->c2;
1189         d2=exchange->d2;
1190         c2d2=exchange->c2d2;
1191
1192         numer=d_ij2+d_ik*d_ik-d_jk*d_jk;
1193         denom=2*d_ij*d_ik;
1194         cos_theta=numer/denom;
1195         sin_theta=sqrt(1.0-(cos_theta*cos_theta));
1196         theta=acos(cos_theta);
1197         d_theta=(-1.0/sqrt(1.0-cos_theta*cos_theta))/(denom*denom);
1198         d_theta1=2*denom-numer*2*d_ik/d_ij;
1199         d_theta2=2*denom-numer*2*d_ij/d_ik;
1200         d_theta1*=d_theta;
1201         d_theta2*=d_theta;
1202
1203         h_cos=(h-cos_theta);
1204         h_cos2=h_cos*h_cos;
1205         d2_h_cos2=d2-h_cos2;
1206
1207         /* some usefull expressions */
1208         frac1=c2/(d2-h_cos2);
1209         bracket1=1+c2d2-frac1;
1210         bracket2=f_c_ik*bracket1;
1211         bracket2_n_1=pow(bracket2,n-1.0);
1212         bracket2_n=bracket2_n_1*bracket2;
1213         bracket3=1+betan*bracket2_n;
1214         bracket3_pow_1=pow(bracket3,(-1.0/(2.0*n))-1.0);
1215         bracket3_pow=bracket3_pow_1*bracket3;
1216
1217         /* now go on with calc of b_ij and derivation of b_ij */
1218         b_ij=chi*bracket3_pow;
1219
1220         /* derivation of theta */
1221         v3_scale(&force,&dist_ij,d_theta1);
1222         v3_scale(&temp,&dist_ik,d_theta2);
1223         v3_add(&force,&force,&temp);
1224
1225         /* part 1 of derivation of b_ij */
1226         v3_scale(&force,&force,sin_theta*2*h_cos*f_c_ik*frac1);
1227
1228         /* part 2 of derivation of b_ij */
1229         v3_scale(&temp,&dist_ik,df_c_ik*bracket1);
1230
1231         /* sum up and scale ... */
1232         v3_add(&temp,&temp,&force);
1233         scale=bracket2_n_1*n*betan*(1+betan*bracket3_pow_1)*chi*(1.0/(2.0*n));
1234         v3_scale(&temp,&temp,scale);
1235
1236         /* now construct an energy and a force out of that */
1237         v3_scale(&temp,&temp,f_a);
1238         v3_scale(&force,&dist_ij,df_a*b_ij);
1239         v3_add(&temp,&temp,&force);
1240         v3_scale(&temp,&temp,f_c);
1241         v3_scale(&force,&dist_ij,df_c*b_ij*f_a);
1242         v3_add(&force,&force,&temp);
1243
1244         /* add forces */
1245         v3_add(&(ai->f),&(ai->f),&force);
1246         /* energy is 0.5 f_r f_c, but we will sum it up twice ... */
1247         moldyn->energy+=(0.25*f_a*b_ij*f_c);
1248                                 
1249         return 0;
1250 }
1251