BrookBonded.cpp 73.8 KB
Newer Older
Mark Friedrichs's avatar
Mark Friedrichs committed
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
/* -------------------------------------------------------------------------- *
 *                                   OpenMM                                   *
 * -------------------------------------------------------------------------- *
 * This is part of the OpenMM molecular simulation toolkit originating from   *
 * Simbios, the NIH National Center for Physics-Based Simulation of           *
 * Biological Structures at Stanford, funded under the NIH Roadmap for        *
 * Medical Research, grant U54 GM072970. See https://simtk.org.               *
 *                                                                            *
 * Portions copyright (c) 2008 Stanford University and the Authors.           *
 * Authors: Mark Friedrichs                                                   *
 * Contributors:                                                              *
 *                                                                            *
 * Permission is hereby granted, free of charge, to any person obtaining a    *
 * copy of this software and associated documentation files (the "Software"), *
 * to deal in the Software without restriction, including without limitation  *
 * the rights to use, copy, modify, merge, publish, distribute, sublicense,   *
 * and/or sell copies of the Software, and to permit persons to whom the      *
 * Software is furnished to do so, subject to the following conditions:       *
 *                                                                            *
 * The above copyright notice and this permission notice shall be included in *
 * all copies or substantial portions of the Software.                        *
 *                                                                            *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR *
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,   *
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL    *
 * THE AUTHORS, CONTRIBUTORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,    *
 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR      *
 * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE  *
 * USE OR OTHER DEALINGS IN THE SOFTWARE.                                     *
 * -------------------------------------------------------------------------- */

#include <math.h>
#include <sstream>
#include "BrookBonded.h"
#include "BrookPlatform.h"
#include "BrookStreamFactory.h"
#include "OpenMMException.h"
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
38
#include "gpu/kinvmap_gather.h"
Mark Friedrichs's avatar
Mark Friedrichs committed
39
40
41
42
43
44
#include "gpu/invmap.h"
#include "gpu/kforce.h"

using namespace OpenMM;
using namespace std;

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
45
#define ATOMS(X,Y) (particles[ 5*(X) + (Y) + 1 ])
Mark Friedrichs's avatar
Mark Friedrichs committed
46
47
48
#define PARAMS(X,Y,Z) (params[(Y)][4*(X) + Z])

/** 
Mark Friedrichs's avatar
Mark Friedrichs committed
49
 *
Mark Friedrichs's avatar
Mark Friedrichs committed
50
51
52
53
54
55
56
57
58
59
60
61
 * BrookBonded constructor
 * 
 */

BrookBonded::BrookBonded( ){

// ---------------------------------------------------------------------------------------

   static const std::string methodName = "BrookBonded::BrookBonded";

// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
62
   _setupCompleted            = 0;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
63
   _numberOfParticles         = 0;
Mark Friedrichs's avatar
Latest  
Mark Friedrichs committed
64

65
   _coulombFactor             = (BrookOpenMMFloat) 138.935485;
Mark Friedrichs's avatar
Mark Friedrichs committed
66

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
67
   _particleIndicesStream     = NULL;
Mark Friedrichs's avatar
Mark Friedrichs committed
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
   _chargeStream              = NULL;

   // parameter streams

   for( int ii = 0; ii < getNumberOfParameterStreams(); ii++ ){
      _bondedParameters[ii] = NULL;
   }

   // inverse maps & force streams

   for( int ii = 0; ii < getNumberOfForceStreams(); ii++ ){
      _bondedForceStreams[ii]       = NULL;
      _inverseMapStreamCount[ii]    = 0;
      for( int jj = 0; jj < MaxNumberOfInverseMaps; jj++ ){
         _inverseStreamMaps[ii][jj] = NULL;
      }
   }

   _maxInverseMapStreamCount[StreamI] = 9;
   _maxInverseMapStreamCount[StreamJ] = 6;
   _maxInverseMapStreamCount[StreamK] = 6;
   _maxInverseMapStreamCount[StreamL] = 9;

   _maxNumberOfInverseMaps = _maxInverseMapStreamCount[0];
   for( int ii = 1; ii < getNumberOfForceStreams(); ii++ ){
      if( _maxNumberOfInverseMaps < _maxInverseMapStreamCount[ii] ){
         _maxNumberOfInverseMaps  = _maxInverseMapStreamCount[ii];
      }
   }

   // check that MaxNumberOfInverseMaps is big enough

   if( _maxNumberOfInverseMaps > MaxNumberOfInverseMaps ){
      std::stringstream message;
      message << methodName << " max number of inverse maps=" << _maxNumberOfInverseMaps << " is greater than hardwired value=" << MaxNumberOfInverseMaps;
      throw OpenMMException( message.str() );
   }

Mark Friedrichs's avatar
Mark Friedrichs committed
106
   _inverseMapStreamWidth = -1;
Mark Friedrichs's avatar
Mark Friedrichs committed
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
}   
 
/** 
 * BrookBonded destructor
 * 
 */

BrookBonded::~BrookBonded( ){

// ---------------------------------------------------------------------------------------

   //static const std::string methodName = "BrookBonded::~BrookBonded";

// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
122
   delete _particleIndicesStream;
Mark Friedrichs's avatar
Mark Friedrichs committed
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
159
160
161
162
163
164
165
166
167
168
169
   delete _chargeStream;

   for( int ii = 0; ii < getNumberOfParameterStreams(); ii++ ){
      delete _bondedParameters[ii];
   }
   for( int ii = 0; ii < getNumberOfForceStreams(); ii++ ){
      delete _bondedForceStreams[ii];
      for( int jj = 0; jj < MaxNumberOfInverseMaps; jj++ ){
         delete _inverseStreamMaps[ii][jj];
      }
   }

}

/** 
 * Get number of parameter streams
 * 
 * @return  number of parameter streams
 *
 */

int BrookBonded::getNumberOfParameterStreams( void ) const {
   return NumberOfParameterStreams;
}

/** 
 * Get number of force streams
 * 
 * @return  number of force streams
 *
 */

int BrookBonded::getNumberOfForceStreams( void ) const {
   return NumberOfForceStreams;
}

/** 
 * Get max number of inverse maps
 * 
 * @return  max number of inverse maps
 *
 */

int BrookBonded::getMaxInverseMapStreamCount( void ) const {
   return _maxNumberOfInverseMaps;
}

Mark Friedrichs's avatar
Mark Friedrichs committed
170
171
172
173
174
175
176
177
178
179
180
181
182
/** 
 * Get max number of inverse maps for specified force stream index
 * 
 * @param index index of force stream
 *
 * @return  max number of inverse maps or -1 if index is out of range
 *
 */

int BrookBonded::getMaxInverseMapStreamCount( int index ) const {
   return (index >= 0 && index < getNumberOfForceStreams())  ? _maxInverseMapStreamCount[index] : -1;
}

Mark Friedrichs's avatar
Mark Friedrichs committed
183
184
185
186
187
188
189
/** 
 * Get width of inverse map streams
 * 
 * @return  width of inverse map streams
 *
 */

Mark Friedrichs's avatar
Mark Friedrichs committed
190
191
int BrookBonded::getInverseMapStreamWidth( void ) const {
   return _inverseMapStreamWidth;
Mark Friedrichs's avatar
Mark Friedrichs committed
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
}

/** 
 * Get Coulomb factor
 * 
 * @return Coulomb factor
 *
 */

BrookOpenMMFloat BrookBonded::getCoulombFactor( void ) const {
   return _coulombFactor;
}

/** 
 * Return true if force[index] stream is set
 *
 * @param    index into force stream
 * @return   true if index is valid && force[index] stream is set; else false
 *
 */

int BrookBonded::isForceStreamSet( int index ) const {
   return (index >= 0 && index < getNumberOfForceStreams() && _bondedForceStreams[index]) ? 1 : 0;
}

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
217
218
219
220
221
222
223
224
225
226
/** 
 * Return SetupCompleted flag
 *
 * @return SetupCompleted flag
 */
          
int BrookBonded::isSetupCompleted( void ) const {
   return _setupCompleted;
}
   
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
227
228
229
230
231
232
233
234
235
236
237
238
239
/** 
 * Set SetupCompleted flag
 *
 * @param  setupCompleted flag
 *
 * @return SetupCompleted flag
 */
          
int BrookBonded::setupCompleted( int setupCompleted ){
   _setupCompleted = setupCompleted;
   return _setupCompleted;
}
   
Mark Friedrichs's avatar
Mark Friedrichs committed
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
/** 
 * Return string showing if all inverse map streams are set
 *
 * @param    index into inverse map stream array
 *
 * @return   informative string
 *
 */

std::string BrookBonded::checkInverseMapStream( int index ) const {

// ---------------------------------------------------------------------------------------

   static const std::string methodName      = "BrookBonded::getContents";
   int ok                                   = 1;

// ---------------------------------------------------------------------------------------

   std::stringstream message;
   if( index < 0 || index >= getNumberOfForceStreams() ){
      message << "Inverse map index=" << index << " is out of range [0, "  << getNumberOfForceStreams() << ")";
      return message.str();
   }

   message << "[ ";
   for( int ii = 0; ii < getInverseMapStreamCount( index ); ii++ ){
      message << (_inverseStreamMaps[index][ii] ? 1 : 0) << " ";
      if( !_inverseStreamMaps[index][ii] ){
         ok = 0;
      }
   }
   message << " ]";
   if( !ok ){
      message << " ERROR!";
   }

   return message.str();
   
}

/** 
 * Return true if paramsterSet[index] stream is set
 *
 * @param    index into parameter stream
 *
 * @return   true if index is valid && paramsterSet[index] stream is set; else false
 *
 */

int BrookBonded::isParameterStreamSet( int index ) const {
   return (index >= 0 && index < getNumberOfParameterStreams() && _bondedParameters[index]) ? 1 : 0;
}

/** 
 * Validate stream count
 * 
 * @return  DefaultReturnValue if count valid; else return ErrorReturnValue
 *
 * @exception OpenMMException is thrown if count is invalid
 *
 */

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
302
int BrookBonded::_validateInverseMapStreamCount( int index, int count ) const {
Mark Friedrichs's avatar
Mark Friedrichs committed
303
304
305

// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
306
   static const std::string methodName = "BrookBonded::_validateInverseMapStreamCount";
Mark Friedrichs's avatar
Mark Friedrichs committed
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353

// ---------------------------------------------------------------------------------------

   int valid = DefaultReturnValue;

   if( index == 2 ){
      if( count > 5 ){
         valid = ErrorReturnValue;
      }
   }

   if( valid == ErrorReturnValue ){
      std::stringstream message;
      message << methodName << " input index=" << index << " has invalid count=" << count;
      throw OpenMMException( message.str() );
   }

   return DefaultReturnValue;
}

/** 
 * Get inverse map stream count
 * 
 * @return  count
 *
 * @exception OpenMMException is thrown if index is out of range [0, getNumberOfForceStreams() ]
 *
 */

int BrookBonded::getInverseMapStreamCount( int index ) const {

// ---------------------------------------------------------------------------------------

   static const std::string methodName = "BrookBonded::getInverseMapStreamCount";

// ---------------------------------------------------------------------------------------

   if( index < 0 || index >= getNumberOfForceStreams() ){
      std::stringstream message;
      message << methodName << " input index=" << index << " is out of range [0, " << getNumberOfForceStreams() << " )";
      throw OpenMMException( message.str() );
   }

   return _inverseMapStreamCount[index];
}

/** 
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
354
 * Get bonded particle indices stream
Mark Friedrichs's avatar
Mark Friedrichs committed
355
 * 
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
356
 * @return  particle indices stream
Mark Friedrichs's avatar
Mark Friedrichs committed
357
358
359
 *
 */

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
360
BrookFloatStreamInternal* BrookBonded::getParticleIndicesStream( void ) const {
Mark Friedrichs's avatar
Mark Friedrichs committed
361
362
363

// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
364
   // static const std::string methodName = "BrookBonded::getParticleIndicesStream";
Mark Friedrichs's avatar
Mark Friedrichs committed
365
366
367

// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
368
   return _particleIndicesStream;
Mark Friedrichs's avatar
Mark Friedrichs committed
369
370
}

371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
/** 
 * Get bonded charge stream
 * 
 * @return  charge stream
 *
 */

BrookFloatStreamInternal* BrookBonded::getChargeStream( void ) const {

// ---------------------------------------------------------------------------------------

   // static const std::string methodName = "BrookBonded::getChargeStream";

// ---------------------------------------------------------------------------------------

   return _chargeStream;
}

Mark Friedrichs's avatar
Mark Friedrichs committed
389
390
391
392
393
394
395
/** 
 * Get array of bonded parameter streams
 * 
 * @return  array of bonded parameter streams
 *
 */

Mark Friedrichs's avatar
Mark Friedrichs committed
396
BrookFloatStreamInternal** BrookBonded::getBondedParameterStreams( void ){
Mark Friedrichs's avatar
Mark Friedrichs committed
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413

// ---------------------------------------------------------------------------------------

   // static const std::string methodName = "BrookBonded::getBondedParameterStreams";

// ---------------------------------------------------------------------------------------

   return _bondedParameters;
}

/** 
 * Get array of force streams
 * 
 * @return  array  force streams
 *
 */

Mark Friedrichs's avatar
Mark Friedrichs committed
414
BrookFloatStreamInternal** BrookBonded::getBondedForceStreams( void ){
Mark Friedrichs's avatar
Mark Friedrichs committed
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433

// ---------------------------------------------------------------------------------------

   // static const std::string methodName = "BrookBonded::getBondedForceStreams";

// ---------------------------------------------------------------------------------------

   return _bondedForceStreams;
}

/** 
 * Get array of inverse map streams
 * 
 * @param index  array index 
 *
 * @return  array inverse map streams
 *
 */

Mark Friedrichs's avatar
Mark Friedrichs committed
434
BrookFloatStreamInternal** BrookBonded::getInverseStreamMapsStreams( int index ){
Mark Friedrichs's avatar
Mark Friedrichs committed
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465

// ---------------------------------------------------------------------------------------

   // static const std::string methodName = "BrookBonded::getInverseStreamMapsStreams";

// ---------------------------------------------------------------------------------------

   // no checking on index -- assume ok -- speed

   return _inverseStreamMaps[index];
}

/* Gromacs sorts most bonded interactions
 * We sort those that gromacs forgets
 * The parameters are all symmetric with respect 
 * to inversion of order.
 * 
 * Also we assume that the same set of indices are not
 * used with different sets of parameters in gromacs
 * This is just an assumption for convenience here,
 * nothing stops us from evaluating such terms in the
 * kernel.
 * 
 * To begin with all interactions have -1 -1 -1 -1
 * After we fit in all the interactions, we have
 * to convert the -1's to zeros to avoid indexing
 * errors on the GPU.
 * */

/*Flips i,j,k,l to l,k,j,i while correctly shuffling the params */

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
466
void BrookBonded::_flipQuartet( int ibonded, int *particles ){
Mark Friedrichs's avatar
Mark Friedrichs committed
467
468
469

// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
470
   // static const std::string methodName = "BrookBonded::_flipQuartet";
Mark Friedrichs's avatar
Mark Friedrichs committed
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488

// ---------------------------------------------------------------------------------------

   int tmp;

   //For now, simply flip the indices
   //we're just studying the packing

   tmp = ATOMS( ibonded, 0 );
   ATOMS( ibonded, 0 ) = ATOMS( ibonded, 3 );
   ATOMS( ibonded, 3 ) = ATOMS( ibonded, 0 );

   tmp = ATOMS( ibonded, 1 );
   ATOMS( ibonded, 1 ) = ATOMS( ibonded, 2 );
   ATOMS( ibonded, 2 ) = ATOMS( ibonded, 1 );

}

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
489
int BrookBonded::_matchTorsion( int i, int j, int k, int l, int nbondeds, int *particles ){
Mark Friedrichs's avatar
Mark Friedrichs committed
490
491
492

// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
493
   // static const std::string methodName = "BrookBonded::_matchTorsion";
Mark Friedrichs's avatar
Mark Friedrichs committed
494
495
496
497
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512
513
514
515
516
517
518
519
520
521
522
523
524

// ---------------------------------------------------------------------------------------

   int tmp;
   if( j > k ){
      //swap into order
      tmp = i;
      i = l;
      l = tmp;

      tmp = j;
      j = k;
      k = tmp;
   }
   
   for( int n = 0; n < nbondeds; n++ ){
      if( i == ATOMS(n, 0) && j == ATOMS(n, 1) && 
          k == ATOMS(n, 2) && l == ATOMS(n, 3) ){
         return n;
      }
   }

   return ErrorReturnValue;
}

/* 
 * We try to match i,j,k against the first 3 in a quartet, then
 * against the next three. Then we check if there's a free slot
 * in the fourth component and match the middle two components
 *
 * The last bit will not be needed as long as gromacs generates
Mark Friedrichs's avatar
Mark Friedrichs committed
525
526
 * all torsions. But I think there are force fields that don't 
 * use all torsions.
Mark Friedrichs's avatar
Mark Friedrichs committed
527
 *
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
528
 * @return ErrorReturnValue if error; else particle index
Mark Friedrichs's avatar
Mark Friedrichs committed
529
530
531
 *
 **/

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
532
533
int BrookBonded::_matchAngle( int i, int j, int k, int nbondeds, 
                              int *particles, int *flag ){
Mark Friedrichs's avatar
Mark Friedrichs committed
534
535
536
537

// ---------------------------------------------------------------------------------------

   int n;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
538
   static const std::string methodName = "BrookBonded::_matchAngle";
Mark Friedrichs's avatar
Mark Friedrichs committed
539
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561
562
563
564
565
566
567
568
569
570
571
572
573
574
575
576
577
578
579
580
581
582
583
584
585
586
587

// ---------------------------------------------------------------------------------------

   // validate i > k

   if( i > k ){
      if( getLog() ){
         (void) fprintf( getLog(), "%s Invalid triplet %d-%d-%d\n", methodName.c_str(), i, j, k );
         (void) fflush( getLog() );
      }
      std::stringstream message;
      message << methodName << " invalid triplet: " << i << "-" << j << "-" << k  << std::endl;
      throw OpenMMException( message.str() );
      return ErrorReturnValue;
   }
   
   for( n = 0; n < nbondeds; n++ ){
      if( j == ATOMS(n, 1) ){
         if(   (i == ATOMS(n, 0) && k == ATOMS(n, 2)) 
             || (i == ATOMS(n, 2) && k == ATOMS(n, 0)) )  {
            *flag = 0;
            return n;
         }
      }
      else if( j == ATOMS(n, 2) ){
         if( i == ATOMS(n, 1) ){
            if( ATOMS(n, 3) == -1 || k == ATOMS(n, 3) ){
               ATOMS(n, 3) = k;
               *flag = 1;
               return n;
            }
         }
         else if( k == ATOMS(n, 1) ){
            if( ATOMS(n, 3) == -1 || i == ATOMS(n, 3) ){
               ATOMS(n, 3) = i;
               *flag = 1;
               return n;
            }
         }
      }
   }
   return ErrorReturnValue;
}

/*flag = 0 means match i-j, 1 means j-k and 2 means k-l
 * Again, like above, if we have uninitialized slots, we take em
 *
 * */

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
588
int BrookBonded::_matchBond( int i, int j, int nbondeds, int *particles, int *flag ){
Mark Friedrichs's avatar
Mark Friedrichs committed
589
590
591

// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
592
   static const std::string methodName = "BrookBonded::_matchBond";
Mark Friedrichs's avatar
Mark Friedrichs committed
593
594
595
596
597
598
599
600
601
602
603
604
605
606
607
608
609
610
611
612
613
614
615
616
617
618
619
620
621
622
623
624
625
626
627

// ---------------------------------------------------------------------------------------

   if( i > j ){
      if( getLog() ){
         (void) fprintf( getLog(), "%s invalid bond %d-%d\n", methodName.c_str(), i, j );
         (void) fflush( getLog() );
      }
      std::stringstream message;
      message << methodName << " invalid bond " << i << "-" << j << std::endl;
      throw OpenMMException( message.str() );
      return ErrorReturnValue;
   }

   for( int n = 0; n < nbondeds; n++ ){

      if( ( i == ATOMS(n, 0) && j == ATOMS(n, 1) ) || ( i == ATOMS(n, 1) && j == ATOMS(n, 0) ) ){

         *flag = 0;
         return n;
      }
      
      //Try second spot

      if(  ATOMS(n, 2) == -1 ){ //One available spot
         if( i == ATOMS(n, 1) ){
            ATOMS(n, 2) = j;
            *flag = 1;
            return n;
         }
         if( j == ATOMS(n, 1) ){
            ATOMS(n, 2) = i;
            *flag = 1;
            return n;
         }
628
      } else if(  ( i == ATOMS(n, 1) && j == ATOMS(n, 2) ) ||( i == ATOMS(n, 2) && j == ATOMS(n, 1) ) ){
Mark Friedrichs's avatar
Mark Friedrichs committed
629
630
631
632
633
634
635
636
637
638
639
640
641
642
643
644
645
646
647
648
649
650
651
652
653
         *flag = 1;
         return n;
      }
      
      //Try third spot
      if( ATOMS(n, 3) == -1 ){
         if( i == ATOMS(n, 2) ){
            ATOMS(n, 3) = j;
            *flag = 2;
            return n;
         }
         if( j == ATOMS(n, 2) ){
            ATOMS(n, 3) = i;
            *flag = 2;
            return n;
         }
      } else if(  ( i == ATOMS(n, 2) && j == ATOMS(n, 3) ) ||( i == ATOMS(n, 3) && j == ATOMS(n, 2) ) ){
         *flag = 2;
         return n;
      }
   }

   return ErrorReturnValue;
}

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
654
int BrookBonded::_matchPair( int i, int j, int nbondeds, int *particles ){
Mark Friedrichs's avatar
Mark Friedrichs committed
655
656
657

// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
658
   //static const std::string methodName = "BrookBonded::_matchPair";
Mark Friedrichs's avatar
Mark Friedrichs committed
659
660
661
662
663
664
665
666
667

// ---------------------------------------------------------------------------------------

   for( int n = 0; n < nbondeds; n++ ){

      //If there is an empty slot available:

      if( ATOMS(n, 0) == -1 ){

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
668
         //If one of i,j matches the l particle
Mark Friedrichs's avatar
Mark Friedrichs committed
669
670
671
672
673
674
675
676
677
678
679

         if( ATOMS(n, 3) == i ){
            ATOMS(n, 0) = j;
            return n;
         }
         if( ATOMS(n, 3) == j ){
            ATOMS(n, 0) = i;
            return n;
         }
      }

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
680
      //If the l-particle is available
Mark Friedrichs's avatar
Mark Friedrichs committed
681
682
683
684
685
686
687
688
689
690
691
692
693
694
695
696
697
698
699
700
701
      if( ATOMS(n, 3) == -1 ){
         if( ATOMS(n, 0) == i ){
            ATOMS(n, 3) = j;
            return n;
         }
         if( ATOMS(n, 0) == j ){
            ATOMS(n, 3) = i;
            return n;
         }
      }

      //Both are unavailable, both much match
      if(   ( i == ATOMS(n, 0) && j == ATOMS(n, 3) ) 
          || ( i == ATOMS(n, 3) && j == ATOMS(n, 0) ) ){
         return n;
      }
   }
   return ErrorReturnValue;
}

/** 
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
702
 * Setup Ryckaert-Bellemans parameters/particle indices
Mark Friedrichs's avatar
Mark Friedrichs committed
703
704
 * 
 * @param nbondeds                  number of bonded entries
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
705
 * @param particles                 array of particle indices
Mark Friedrichs's avatar
Mark Friedrichs committed
706
 * @param params                    arrays of bond parameters
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
707
 * @param rbTorsionIndices          the four particles connected by each Ryckaert-Bellemans torsion term
Mark Friedrichs's avatar
Mark Friedrichs committed
708
709
710
711
712
713
714
 * @param rbTorsionParameters       the coefficients (in order of increasing powers) for each Ryckaert-Bellemans torsion term
 * @param log                       log reference
 *
 * @return nonzero value if error
 *
 */

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
715
716
717
int BrookBonded::_addRBTorsions( int *nbondeds, int *particles, float *params[], 
                                 const vector<vector<int> >& rbTorsionIndices, 
                                 const vector<vector<double> >& rbTorsionParameters ){
Mark Friedrichs's avatar
Mark Friedrichs committed
718
719
720

// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
721
   static const std::string methodName = "BrookBonded::_addRBTorsions";
Mark Friedrichs's avatar
Mark Friedrichs committed
722
723
724
725
726
727
728
729
730
731
   static const int debug              = 0;

// ---------------------------------------------------------------------------------------

   if( debug && getLog() ){
      (void) fprintf( getLog(), "%s number of bonds=%d\n", methodName.c_str(), rbTorsionIndices.size() );
   }

   for( unsigned int ii = 0; ii < rbTorsionIndices.size(); ii++ ){

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
732
      vector<int> particlesIndices  = rbTorsionIndices[ii];
Mark Friedrichs's avatar
Mark Friedrichs committed
733
734
735
      vector<double> rbParameters   = rbTorsionParameters[ii];

      int index = 0;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
736
737
738
739
      int i     = particlesIndices[index++];
      int j     = particlesIndices[index++];
      int k     = particlesIndices[index++];
      int l     = particlesIndices[index++];
Mark Friedrichs's avatar
Mark Friedrichs committed
740
      
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
741
      int ibonded = _matchTorsion( i, j, k, l, *nbondeds, particles );
Mark Friedrichs's avatar
Mark Friedrichs committed
742
743
744
745
746
747
748
749
750
751
      
      if( ibonded < 0 ){
         ibonded             = *nbondeds;
         ATOMS( ibonded, 0 ) = i;
         ATOMS( ibonded, 1 ) = j;
         ATOMS( ibonded, 2 ) = k;
         ATOMS( ibonded, 3 ) = l;
         (*nbondeds)++;
      }

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
752
753
754
755
      // note -- we are starting w/ index c1 not c0 -- c0 is not used
      // to calculate the forces!

      index                   = 1;
Mark Friedrichs's avatar
Mark Friedrichs committed
756
757
758
759
760
761
762
763
764
      PARAMS( ibonded, 0, 0 ) = (BrookOpenMMFloat) rbParameters[index++];
      PARAMS( ibonded, 0, 1 ) = (BrookOpenMMFloat) rbParameters[index++];
      PARAMS( ibonded, 0, 2 ) = (BrookOpenMMFloat) rbParameters[index++];
      PARAMS( ibonded, 0, 3 ) = (BrookOpenMMFloat) rbParameters[index++];
      PARAMS( ibonded, 1, 0 ) = (BrookOpenMMFloat) rbParameters[index++];

      if( debug && getLog() ){
         (void) fprintf( getLog(), "   %d [%d %d %d %d] %.3e %.3e %.3e %.3e\n", ibonded, i, j, k, l,
                         rbParameters[0], rbParameters[1],
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
765
                         rbParameters[2], rbParameters[3], rbParameters[4], rbParameters[5] );
Mark Friedrichs's avatar
Mark Friedrichs committed
766
767
768
769
770
771
772
      }
   }

   return DefaultReturnValue;
}

/**
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
773
 * Setup periodic torsion parameters/particle indices
Mark Friedrichs's avatar
Mark Friedrichs committed
774
775
 * 
 * @param nbondeds                  number of bonded entries
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
776
 * @param particles                 array of particle indices
Mark Friedrichs's avatar
Mark Friedrichs committed
777
 * @param params                    arrays of bond parameters
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
778
 * @param periodicTorsionIndices    the four particles connected by each periodic torsion term
Mark Friedrichs's avatar
Mark Friedrichs committed
779
780
781
782
783
784
785
 * @param periodicTorsionParameters the force parameters (k, phase, periodicity) for each periodic torsion term
 * @param log                       log reference
 *
 * @return nonzero value if error
 *
 */

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
786
787
788
int BrookBonded::_addPTorsions( int *nbondeds, int *particles, BrookOpenMMFloat* params[],
                                const vector<vector<int> >& periodicTorsionIndices, 
                                const vector<vector<double> >& periodicTorsionParameters ){
Mark Friedrichs's avatar
Mark Friedrichs committed
789
790
791

// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
792
   static const std::string methodName = "BrookBonded::_addPTorsion";
Mark Friedrichs's avatar
Mark Friedrichs committed
793
794
795
796
797
798
799
800
801
802
   static const int debug              = 0;

// ---------------------------------------------------------------------------------------

   if( debug && getLog() ){
      (void) fprintf( getLog(), "%s npdih=%d\n", methodName.c_str(), periodicTorsionIndices.size() );
   }

   for( unsigned int ii = 0; ii < periodicTorsionIndices.size(); ii++ ){

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
803
      vector<int> particlesIndices      = periodicTorsionIndices[ii];
Mark Friedrichs's avatar
Mark Friedrichs committed
804
805
806
      vector<double> pTParameters   = periodicTorsionParameters[ii];

      int index = 0;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
807
808
809
810
      int i     = particlesIndices[index++];
      int j     = particlesIndices[index++];
      int k     = particlesIndices[index++];
      int l     = particlesIndices[index++];
Mark Friedrichs's avatar
Mark Friedrichs committed
811

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
812
      int ibonded = _matchTorsion( i, j, k, l, *nbondeds, particles );
Mark Friedrichs's avatar
Mark Friedrichs committed
813
814
815
816
817
818
819
820
821
      
      if( ibonded < 0 ){
         ibonded = *nbondeds;
         ATOMS( ibonded, 0 ) = i;
         ATOMS( ibonded, 1 ) = j;
         ATOMS( ibonded, 2 ) = k;
         ATOMS( ibonded, 3 ) = l;
         (*nbondeds)++;
      }
Mark Friedrichs's avatar
Mark Friedrichs committed
822
823
824
825

      // note: parameters 0 & 2 switched

      PARAMS( ibonded, 1, 1 ) = (BrookOpenMMFloat) pTParameters[2];
Mark Friedrichs's avatar
Mark Friedrichs committed
826
      PARAMS( ibonded, 1, 2 ) = (BrookOpenMMFloat) pTParameters[1];
Mark Friedrichs's avatar
Mark Friedrichs committed
827
      PARAMS( ibonded, 1, 3 ) = (BrookOpenMMFloat) pTParameters[0];
Mark Friedrichs's avatar
Mark Friedrichs committed
828
829
830
831
832
833
834
835
836
837
838

      if( debug && getLog() ){
         (void) fprintf( getLog(), "   %d [%d %d %d %d] %.3e %.3e %.3e\n", ibonded, i, j, k, l,
                         pTParameters[0], pTParameters[1], pTParameters[2] );
      }
   }

   return DefaultReturnValue;
}

/**
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
839
 * Setup angle bond parameters/particle indices
Mark Friedrichs's avatar
Mark Friedrichs committed
840
841
 * 
 * @param nbondeds                  number of bonded entries
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
842
 * @param particles                 array of particle indices
Mark Friedrichs's avatar
Mark Friedrichs committed
843
 * @param params                    arrays of bond parameters
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
844
 * @param angleIndices              the angle bond particle indices
Mark Friedrichs's avatar
Mark Friedrichs committed
845
846
847
848
849
850
851
 * @param angleParameters           the angle parameters (angle in radians, force constant)
 * @param log                       log reference
 *
 * @return nonzero value if error
 *
 */

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
852
853
int BrookBonded::_addAngles( int *nbondeds, int *particles, float *params[], const std::vector<std::vector<int> >& angleIndices,
                             const std::vector<std::vector<double> >& angleParameters ){
Mark Friedrichs's avatar
Mark Friedrichs committed
854
855
856

// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
857
   static const std::string methodName = "BrookBonded::_addAngles";
Mark Friedrichs's avatar
Mark Friedrichs committed
858
859
860
861
862
863
864
865
866
867
868
869
   static const int debug              = 0;

// ---------------------------------------------------------------------------------------

   if( debug && getLog() ){
      (void) fprintf( getLog(), "%s nang=%d\n", methodName.c_str(), angleIndices.size() );
   }

   // loop over bonds

   for( unsigned int ii = 0; ii < angleIndices.size(); ii++ ){

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
870
      vector<int> particlesIndices   = angleIndices[ii];
Mark Friedrichs's avatar
Mark Friedrichs committed
871
872
873
      vector<double> angParameters   = angleParameters[ii];

      int index = 0;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
874
875
876
      int i     = particlesIndices[index++];
      int j     = particlesIndices[index++];
      int k     = particlesIndices[index++];
Mark Friedrichs's avatar
Mark Friedrichs committed
877
878
 
      int flag;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
879
      int ibonded = _matchAngle( i, j, k, *nbondeds, particles, &flag );
Mark Friedrichs's avatar
Mark Friedrichs committed
880
881
882
883
884
885
886
887
888
889
890
891
892
893
894
895
896
897
898
899
900
      if( ibonded < 0 ){
         ibonded = *nbondeds;
         ATOMS( ibonded, 0 ) = i;
         ATOMS( ibonded, 1 ) = j;
         ATOMS( ibonded, 2 ) = k;
         flag = 0;
         (*nbondeds)++;
      }
      PARAMS( ibonded, 2, flag*2 )     = (BrookOpenMMFloat) angParameters[0];
      PARAMS( ibonded, 2, flag*2 + 1 ) = (BrookOpenMMFloat) angParameters[1];
      
      if( debug && getLog() ){
         (void) fprintf( getLog(), "   %d [%d %d %d ] %.6e %.6e\n", ibonded, i, j, k,
                         angParameters[0], angParameters[1] );
      }
   }

   return DefaultReturnValue;
}

/**
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
901
 * Setup harmonic bond parameters/particle indices
Mark Friedrichs's avatar
Mark Friedrichs committed
902
903
 * 
 * @param nbondeds                  number of bonded entries
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
904
 * @param particles                 array of particle indices
Mark Friedrichs's avatar
Mark Friedrichs committed
905
 * @param params                    arrays of bond parameters
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
906
 * @param bondIndices               two harmonic bond particle indices
Mark Friedrichs's avatar
Mark Friedrichs committed
907
908
909
910
911
912
913
 * @param bondParameters            the force parameters (distance, k)
 * @param log                       log reference
 *
 * @return nonzero value if error
 *
 */

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
914
915
int BrookBonded::_addBonds( int *nbondeds, int *particles, float *params[], const vector<vector<int> >& bondIndices,
                            const vector<vector<double> >& bondParameters ){
Mark Friedrichs's avatar
Mark Friedrichs committed
916
917
918

// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
919
   static const std::string methodName = "BrookBonded::_addBonds";
Mark Friedrichs's avatar
Mark Friedrichs committed
920
   static const int debug              = 0;
Mark Friedrichs's avatar
Mark Friedrichs committed
921
922
923
924
925
926
927
928
929
930
931

// ---------------------------------------------------------------------------------------

   if( debug && getLog() ){
      (void) fprintf( getLog(), "%s nbonds=%d\n", methodName.c_str(), bondIndices.size() );
   }

   // loop over bonds

   for( unsigned int ii = 0; ii < bondIndices.size(); ii++ ){

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
932
      vector<int> particlesIndices   = bondIndices[ii];
Mark Friedrichs's avatar
Mark Friedrichs committed
933
934
935
      vector<double> bndParameters   = bondParameters[ii];

      int index = 0;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
936
937
      int i     = particlesIndices[index++];
      int j     = particlesIndices[index++];
Mark Friedrichs's avatar
Mark Friedrichs committed
938

939
940
941
942
943
944
945
946
      // insure i < j

      if( i > j ){
         int k = i;
         i     = j;
         j     = k;
      }

Mark Friedrichs's avatar
Mark Friedrichs committed
947
      int flag;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
948
      int ibonded = _matchBond( i, j, *nbondeds, particles, &flag );
949
int saveIbond = ibonded;
Mark Friedrichs's avatar
Mark Friedrichs committed
950
951
952
953
954
955
956
957
958
959
960
961
962
963
964
965
966
      if( ibonded < 0 ){
         ibonded = *nbondeds;
         ATOMS( ibonded, 0 ) = i;
         ATOMS( ibonded, 1 ) = j;
         flag = 0;
         (*nbondeds)++;
      }

      if( flag < 2 ){
         PARAMS( ibonded, 3, flag*2 )     = (BrookOpenMMFloat) bndParameters[0];
         PARAMS( ibonded, 3, flag*2 + 1 ) = (BrookOpenMMFloat) bndParameters[1];
      } else {
         PARAMS( ibonded, 4, 0 )          = (BrookOpenMMFloat) bndParameters[0];
         PARAMS( ibonded, 4, 1 )          = (BrookOpenMMFloat) bndParameters[1];
      }

      if( debug && getLog() ){
967
         (void) fprintf( getLog(), "   %d (%5d) [%6d %6d ] flag=%2d %.3e %.3e\n", ibonded, saveIbond, i, j, flag,
Mark Friedrichs's avatar
Mark Friedrichs committed
968
969
970
971
972
973
974
975
                         bndParameters[0], bndParameters[1] );
      }
   }

   return DefaultReturnValue;
}

/**
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
976
 * Setup LJ/Coulomb 1-4 parameters/particle indices
Mark Friedrichs's avatar
Mark Friedrichs committed
977
978
 * 
 * @param nbondeds                  number of bonded entries
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
979
 * @param particles                 array of particle indices
Mark Friedrichs's avatar
Mark Friedrichs committed
980
981
 * @param params                    arrays of bond parameters
 * @param charges                   array of charges
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
982
 * @param bonded14Indices           each element contains the indices of two particles whose nonbonded interactions should be reduced since
Mark Friedrichs's avatar
Mark Friedrichs committed
983
 *                                  they form a bonded 1-4 pair
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
984
 * @param nonbondedParameters       the nonbonded force parameters (charge, sigma, epsilon) for each particle
Mark Friedrichs's avatar
Mark Friedrichs committed
985
986
987
988
989
990
 * @param log                       log reference
 *
 * @return nonzero value if error
 *
 */

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
991
992
993
994
int BrookBonded::_addPairs( int *nbondeds, int *particles, BrookOpenMMFloat* params[],
                            BrookOpenMMFloat* charges,
                            const std::vector<std::vector<int> >& bonded14Indices,
                            const std::vector<std::vector<double> >& nonbondedParameters ){
Mark Friedrichs's avatar
Mark Friedrichs committed
995
996
997

// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
998
   static const std::string methodName = "BrookBonded::_addPairs";
Mark Friedrichs's avatar
Mark Friedrichs committed
999
   static const double oneSixth        = 1.0/6.0;
1000
   static const int debug              = 1;
Mark Friedrichs's avatar
Mark Friedrichs committed
1001
1002
1003
1004

// ---------------------------------------------------------------------------------------

   if( debug && getLog() ){
Mark Friedrichs's avatar
Latest  
Mark Friedrichs committed
1005
      (void) fprintf( getLog(), "%s npairs=%d sz=%u %u\n", methodName.c_str(), bonded14Indices.size(), bonded14Indices.size(), nonbondedParameters.size() ); fflush( getLog() );
Mark Friedrichs's avatar
Mark Friedrichs committed
1006
1007
1008
1009
   }

   for( unsigned int ii = 0; ii < bonded14Indices.size(); ii++ ){

Mark Friedrichs's avatar
Latest  
Mark Friedrichs committed
1010
1011
      int i     = bonded14Indices[ii][0];
      int j     = bonded14Indices[ii][1];
Mark Friedrichs's avatar
Mark Friedrichs committed
1012

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1013
      int ibonded = _matchPair( i, j, *nbondeds, particles );
Mark Friedrichs's avatar
Mark Friedrichs committed
1014
1015
1016
1017
1018
1019
1020
      if( ibonded < 0 ){
         ibonded = *nbondeds;
         ATOMS(ibonded, 0) = i;
         ATOMS(ibonded, 3) = j;
         (*nbondeds)++;
      }

Mark Friedrichs's avatar
Latest  
Mark Friedrichs committed
1021
//(void) fprintf( getLog(), "%s   %d %ibonded=%d done\n", methodName.c_str(), ii, ibonded ); fflush( getLog() );
Mark Friedrichs's avatar
Mark Friedrichs committed
1022

Mark Friedrichs's avatar
Latest  
Mark Friedrichs committed
1023
1024
1025
1026
      vector<double> iParameters  = nonbondedParameters[ii];
/*
      double c6                   = iParameters[1];
      double c12                  = 4.0*iParameters[2];
Mark Friedrichs's avatar
Mark Friedrichs committed
1027
1028
      double sig, eps;
      if( c12 != 0.0 ){
1029
1030
1031
1032
         //eps = c6*c6/c12;
         //sig = pow( c12/c6, oneSixth );
         eps = c12;
         sig = c6;
Mark Friedrichs's avatar
Mark Friedrichs committed
1033
1034
1035
1036
      } else {
         eps = 0.0;
         sig = 1.0;
      }
Mark Friedrichs's avatar
Latest  
Mark Friedrichs committed
1037
*/
Mark Friedrichs's avatar
Mark Friedrichs committed
1038

Mark Friedrichs's avatar
Latest  
Mark Friedrichs committed
1039
1040
      PARAMS( ibonded, 4, 2 ) = (BrookOpenMMFloat) iParameters[1];
      PARAMS( ibonded, 4, 3 ) = (BrookOpenMMFloat) (4.0*iParameters[2]);
Mark Friedrichs's avatar
Mark Friedrichs committed
1041
1042
1043

      // a little wasteful, but ...

Mark Friedrichs's avatar
Latest  
Mark Friedrichs committed
1044
      charges[ibonded] = (BrookOpenMMFloat) iParameters[0];
Mark Friedrichs's avatar
Mark Friedrichs committed
1045
1046

      if( debug ){
Mark Friedrichs's avatar
Latest  
Mark Friedrichs committed
1047
         (void) fprintf( getLog(), "   %d [%d %d ] %.3e %.3e q=%.4f\n", ibonded, i, j, iParameters[1], iParameters[2], charges[ibonded] );
Mark Friedrichs's avatar
Mark Friedrichs committed
1048
1049
1050
1051
1052
1053
1054
1055
1056
1057
      }
   }

   return DefaultReturnValue;
}

/** 
 * Create and load inverse maps for bonded ixns
 * 
 * @param nbondeds                  number of bonded entries
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1058
1059
 * @param nparticles                number of particles
 * @param particles                 arrays of particle indices (particles[numberOfBonds][4])
Mark Friedrichs's avatar
Mark Friedrichs committed
1060
1061
1062
1063
1064
1065
1066
 * @param platform                  BrookPlatform reference
 * @param log                       log file reference (optional)
 *
 * @return nonzero value if error
 *
 */

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1067
int BrookBonded::_loadInvMaps( int nbondeds, int nparticles, int *particles, int particleStreamWidth, int particleStreamSize ){
Mark Friedrichs's avatar
Mark Friedrichs committed
1068
1069
1070

// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1071
   static const std::string methodName = "BrookBonded::_loadInvMaps";
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1072
   static const int PrintOn            = 0;
Mark Friedrichs's avatar
Mark Friedrichs committed
1073
   double dangleValue                  = 0.0;
Mark Friedrichs's avatar
Mark Friedrichs committed
1074
1075
1076

// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1077
   // get particle stream size
Mark Friedrichs's avatar
Mark Friedrichs committed
1078

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1079
/*
Mark Friedrichs's avatar
Mark Friedrichs committed
1080
   const BrookStreamFactory& brookStreamFactory = dynamic_cast<const BrookStreamFactory&> (brookPlatform.getDefaultStreamFactory() );
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1081
1082
1083
   int particleStreamWidth                      = brookStreamFactory.getDefaultParticleStreamWidth();
   int particleStreamSize                       = brookPlatform.getStreamSize( getNumberOfParticles(), particleStreamWidth, NULL );
*/
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1084
   _inverseMapStreamWidth                       = particleStreamWidth;
Mark Friedrichs's avatar
Mark Friedrichs committed
1085
   
1086
1087
// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Mark Friedrichs committed
1088
1089
1090
   // allocate temp memory

   float4** invmaps = new float4*[getMaxInverseMapStreamCount()];
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1091
   float* block     = new float[4*getMaxInverseMapStreamCount()*particleStreamSize];
1092

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1093
   //memset( block, 0, 4*getMaxInverseMapStreamCount()*particleStreamSize*sizeof( float ) );
1094
1095

   float* blockPtr = block;
Mark Friedrichs's avatar
Mark Friedrichs committed
1096
   for( int ii = 0; ii < getMaxInverseMapStreamCount(); ii++ ){
1097
      invmaps[ii]  = (float4*) blockPtr;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1098
      blockPtr    += 4*particleStreamSize;
Mark Friedrichs's avatar
Mark Friedrichs committed
1099
   }
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1100
   int* counts = new int[particleStreamSize];
Mark Friedrichs's avatar
Mark Friedrichs committed
1101

1102
1103
// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Mark Friedrichs committed
1104
1105
   // get inverse maps and load into streams

Mark Friedrichs's avatar
Mark Friedrichs committed
1106
1107
1108
1109
   // create streams
   // done independently from loading since for test cases some stream counts == 0, but kernels expect stream to
   // have been created even though unused

1110
1111
   // load streams -- initialize all streams even if unused since gather methods will still pick up

Mark Friedrichs's avatar
Mark Friedrichs committed
1112
1113
   for( int ii = 0; ii < getNumberOfForceStreams(); ii++ ){
      for( int jj = 0; jj < getMaxInverseMapStreamCount(ii); jj++ ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1114
1115
         _inverseStreamMaps[ii][jj] = new BrookFloatStreamInternal( BrookCommon::BondedInverseMapStreams, particleStreamSize,
                                                                    particleStreamWidth, BrookStreamInternal::Float4, dangleValue );
Mark Friedrichs's avatar
Mark Friedrichs committed
1116
1117
1118
      }
   }

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1119
   if( PrintOn && getLog() ){
1120
1121
      (void) fprintf( getLog(), "%s force stream strms=%d nbondeds=%d max counts=[%d %d %d %d] strSz&Wd=%d %d\n", methodName.c_str(), getNumberOfForceStreams(),
                      nbondeds, getMaxInverseMapStreamCount(0), getMaxInverseMapStreamCount(1), getMaxInverseMapStreamCount(2), getMaxInverseMapStreamCount(3),
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1122
                      particleStreamSize, particleStreamWidth );
1123
1124
1125
      (void) fflush( getLog() );
   }

Mark Friedrichs's avatar
Mark Friedrichs committed
1126
1127
   // load data

Mark Friedrichs's avatar
Mark Friedrichs committed
1128
   for( int ii = 0; ii < getNumberOfForceStreams(); ii++ ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1129
      for( int jj = 0; jj < 4*getMaxInverseMapStreamCount()*particleStreamSize; jj++ ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1130
1131
         block[jj] = -1.0f;
      }
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1132
      _gpuCalcInvMap( ii, 4, nbondeds, nparticles, particles, getInverseMapStreamCount( ii ), counts, invmaps, &(_inverseMapStreamCount[ii]) );
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1133
//gpuPrintInvMaps( _inverseMapStreamCount[ii], nparticles, counts, invmaps, getLog() );
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1134
      _validateInverseMapStreamCount( ii, _inverseMapStreamCount[ii] ); 
Mark Friedrichs's avatar
Mark Friedrichs committed
1135
1136
      for( int jj = 0; jj < _inverseMapStreamCount[ii]; jj++ ){
         _inverseStreamMaps[ii][jj]->loadFromArray( invmaps[jj] );
1137

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1138
1139
1140
1141
         if( PrintOn && getLog() ){
            (void) fprintf( getLog(), "%s inverseMap stream strms=%d count=%d index=%d %d InverseMapStreamCount[ii]=%d max=%d\n",
                            methodName.c_str(), getNumberOfForceStreams(), _inverseMapStreamCount[ii], ii, jj,
                            getInverseMapStreamCount( ii ), getMaxInverseMapStreamCount( ii ) );
1142

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1143
            for( int kk = 0; kk < particleStreamSize; kk++ ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1144
1145
               (void) fprintf( getLog(), "%8d [ %.1f %.1f %.1f %.1f]\n", kk, invmaps[jj][kk].x, invmaps[jj][kk].y, invmaps[jj][kk].z, invmaps[jj][kk].w  );
            }
1146
1147
1148
1149
1150
1151
1152
1153
         }

      }    

      // for small systems, must all initialize inverse maps to negative values in order to 
      // keep invalid entries from being included in forces

      if( _inverseMapStreamCount[ii] < getMaxInverseMapStreamCount( ii ) ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1154
         for( int jj = 0; jj < 4*particleStreamSize; jj++ ){
1155
1156
1157
1158
1159
            block[jj] = -1.0f;
         }
         for( int jj = _inverseMapStreamCount[ii]; jj < getMaxInverseMapStreamCount( ii ); jj++ ){
             _inverseStreamMaps[ii][jj]->loadFromArray( invmaps[0] );
         }
Mark Friedrichs's avatar
Mark Friedrichs committed
1160
1161
      }    

Mark Friedrichs's avatar
Mark Friedrichs committed
1162
1163
   }

1164
1165
   // diagnostics 

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1166
   if( PrintOn && getLog() ){
Mark Friedrichs's avatar
Mark Friedrichs committed
1167
1168
1169
1170
1171
1172
      (void) fprintf( getLog(), "%s done\n", methodName.c_str() );
      (void) fflush( getLog() );
   }

   // free memory

1173
1174
1175
   delete[] counts;
   delete[] invmaps[0];
   delete[] invmaps;
Mark Friedrichs's avatar
Mark Friedrichs committed
1176
1177
1178
1179
1180
1181
1182

   return DefaultReturnValue;
}

/* 
 * Setup for bonded ixns
 *
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1183
1184
 * @param numberOfParticles            number of particles
 * @param bondIndices                  vector of vector of harmonic                   bond indices    -- one entry each bond (2 particles     )
Mark Friedrichs's avatar
Mark Friedrichs committed
1185
 * @param bondParameters               vector of vector of harmonic                   bond parameters -- one entry each bond (2 parameters)
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1186
 * @param angleIndices                 vector of vector of angle                      bond indices    -- one entry each bond (3 particles     )
Mark Friedrichs's avatar
Mark Friedrichs committed
1187
 * @param angleParameters              vector of vector of angle                      bond parameters -- one entry each bond (2 parameters)
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1188
 * @param periodicTorsionIndices       vector of vector of periodicTorsionIndices     bond indices    -- one entry each bond (4 particles     )
Mark Friedrichs's avatar
Mark Friedrichs committed
1189
 * @param periodicTorsionParameters    vector of vector of periodicTorsionParameters  bond parameters -- one entry each bond (3 parameters)
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1190
 * @param rbTorsionIndices             vector of vector of rb torsion                 bond indices    -- one entry each bond (4 particles     )
Mark Friedrichs's avatar
Mark Friedrichs committed
1191
 * @param rbTorsionParameters          vector of vector of rb torsion                 bond parameters -- one entry each bond (5 parameters)
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1192
 * @param bonded14Indices              vector of vector of Lennard-Jones 14           particle indices    -- one entry each bond (2 particles     )
Mark Friedrichs's avatar
Mark Friedrichs committed
1193
1194
1195
1196
1197
1198
1199
1200
1201
1202
1203
1204
1205
1206
1207
 * @param nonbondedParameters          vector of vector of Lennard-Jones 14           parameters      -- one entry each bond (3 parameters)
 * @param platform                     Brook platform reference
 *
 * @return always 1
 *
 * We go through the interactions in the following order
 * torsions
 * angles
 * 14 interactions
 * bonds
 * For each new interaction, we try to fit it in with 
 * those already in. This may not necessarily result in
 * the optimal fit, but should not be too bad. 
 * */

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1208
int BrookBonded::setup( int numberOfParticles,
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1209
1210
1211
1212
1213
                        BrookBondParameters* harmonicBondBrookBondParameters,
                        BrookBondParameters* harmonicAngleBrookBondParameters,
                        BrookBondParameters* periodicTorsionBrookBondParameters,
                        BrookBondParameters* rbTorsionBrookBondParameters,
                        BrookBondParameters* nonBonded14ForceParameters,  
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1214
                        int particleStreamWidth, int particleStreamSize ){
Mark Friedrichs's avatar
Mark Friedrichs committed
1215
1216
1217
1218

// ---------------------------------------------------------------------------------------

   static const std::string methodName = "BrookBonded::setup";
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1219
   static const int PrintOn            = 0;
Mark Friedrichs's avatar
Mark Friedrichs committed
1220
   double dangleValue                  = 0.0;
Mark Friedrichs's avatar
Mark Friedrichs committed
1221
1222
1223

// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Latest  
Mark Friedrichs committed
1224
1225
   if( PrintOn && getLog() ){
      (void) fprintf( getLog(), "%s particles=%d\n   [%p %p %p %p %p] (bond, angle, pd, rb, 14)\n"
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1226
1227
1228
                      "StreamW=%d StreamSz=%d\n", methodName.c_str(), numberOfParticles, harmonicBondBrookBondParameters,
                      harmonicAngleBrookBondParameters,
                      periodicTorsionBrookBondParameters, rbTorsionBrookBondParameters, nonBonded14ForceParameters,
Mark Friedrichs's avatar
Latest  
Mark Friedrichs committed
1229
1230
1231
                      particleStreamWidth, particleStreamSize ); fflush( getLog() );
   }

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1232
   _numberOfParticles = numberOfParticles;
Mark Friedrichs's avatar
Mark Friedrichs committed
1233

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1234
   // check that particle indices & parameters agree
Mark Friedrichs's avatar
Mark Friedrichs committed
1235
1236
1237

   // allocate temp memory

Mark Friedrichs's avatar
Mark Friedrichs committed
1238
   int maxBonds     = 10*numberOfParticles;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1239
   int* particles   = new int[5*maxBonds];
Mark Friedrichs's avatar
Latest  
Mark Friedrichs committed
1240
   float* charges   = new BrookOpenMMFloat[maxBonds];
Mark Friedrichs's avatar
Mark Friedrichs committed
1241
1242
1243
1244
1245

   BrookOpenMMFloat** params = new BrookOpenMMFloat*[getNumberOfParameterStreams()];
   for( int ii = 0; ii < getNumberOfParameterStreams(); ii++ ){
      params[ii] = new BrookOpenMMFloat[4*maxBonds];
   }
1246
1247
1248
1249
1250

// ---------------------------------------------------------------------------------------

   // build streams

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1251
1252
//   const BrookStreamFactory& brookStreamFactory = dynamic_cast<const BrookStreamFactory&> (brookPlatform.getDefaultStreamFactory() );
//   int particleStreamWidth                      = brookStreamFactory.getDefaultParticleStreamWidth();
Mark Friedrichs's avatar
Mark Friedrichs committed
1253

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1254
   // Initialize all particle indices to -1 to indicate empty slots
Mark Friedrichs's avatar
Mark Friedrichs committed
1255
1256
1257
   // All parameters must be initialized to values that will 
   // produce zero for the corresponding force. 

Mark Friedrichs's avatar
Latest  
Mark Friedrichs committed
1258
   memset( charges, 0, maxBonds*sizeof( BrookOpenMMFloat ) );
Mark Friedrichs's avatar
Mark Friedrichs committed
1259
1260
1261
1262
1263
1264
1265
1266
1267
1268
1269
1270
1271
1272
1273
1274
1275
1276
1277
   for( int ii = 0; ii < maxBonds; ii++ ){

      ATOMS( ii, 0 ) = -1;
      ATOMS( ii, 1 ) = -1;
      ATOMS( ii, 2 ) = -1;
      ATOMS( ii, 3 ) = -1;
   
      for( int jj = 0; jj < getNumberOfParameterStreams(); jj++ ){
         PARAMS( ii, jj, 0 ) = 0.0; 
         PARAMS( ii, jj, 1 ) = 0.0; 
         PARAMS( ii, jj, 2 ) = 0.0; 
         PARAMS( ii, jj, 3 ) = 0.0; 
      }

      //Set sigma negative to indicate no pair
      PARAMS( ii, 4, 2 ) = -1.0;
   }

   // nbondeds tracks number of ixn
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1278

Mark Friedrichs's avatar
Mark Friedrichs committed
1279
   int nbondeds = 0;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1280

Mark Friedrichs's avatar
Mark Friedrichs committed
1281
   if( rbTorsionBrookBondParameters ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1282
      _addRBTorsions( &nbondeds, particles, params, rbTorsionBrookBondParameters->getParticleIndices(),         rbTorsionBrookBondParameters->getBondParameters() );
Mark Friedrichs's avatar
Mark Friedrichs committed
1283
1284
   }
   if( periodicTorsionBrookBondParameters ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1285
      _addPTorsions(  &nbondeds, particles, params, periodicTorsionBrookBondParameters->getParticleIndices(),   periodicTorsionBrookBondParameters->getBondParameters() );
Mark Friedrichs's avatar
Mark Friedrichs committed
1286
1287
   }
   if( harmonicAngleBrookBondParameters ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1288
      _addAngles(     &nbondeds, particles, params, harmonicAngleBrookBondParameters->getParticleIndices(),     harmonicAngleBrookBondParameters->getBondParameters() );
Mark Friedrichs's avatar
Mark Friedrichs committed
1289
1290
   }
   if( harmonicBondBrookBondParameters ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1291
      _addBonds(      &nbondeds, particles, params, harmonicBondBrookBondParameters->getParticleIndices(),      harmonicBondBrookBondParameters->getBondParameters() );
Mark Friedrichs's avatar
Mark Friedrichs committed
1292
1293
   }
   if( nonBonded14ForceParameters ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1294
      _addPairs(      &nbondeds, particles, params, charges, nonBonded14ForceParameters->getParticleIndices(), nonBonded14ForceParameters->getBondParameters() );
Mark Friedrichs's avatar
Mark Friedrichs committed
1295
   }
Mark Friedrichs's avatar
Mark Friedrichs committed
1296

Mark Friedrichs's avatar
Latest  
Mark Friedrichs committed
1297
1298
// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Mark Friedrichs committed
1299
1300
1301
1302
   // check that number of bonds not too large for memory allocated

   if( nbondeds >= maxBonds ){
      std::stringstream message;
Mark Friedrichs's avatar
Mark Friedrichs committed
1303
      message << methodName << " number of bonds=" << nbondeds << " is greater than maxBonds=" << maxBonds << " numberOfParticles=" << numberOfParticles;
Mark Friedrichs's avatar
Mark Friedrichs committed
1304
      throw OpenMMException( message.str() );
Mark Friedrichs's avatar
Latest  
Mark Friedrichs committed
1305
1306
1307
1308
1309
1310
1311
1312
1313

   } else if( nbondeds < 1 ){

      // return if no bonds

      (void) fprintf( getLog(), "%s WARNING: particles=%d number of bonds=%d maxBonds=%d\n", methodName.c_str(), numberOfParticles, nbondeds, maxBonds );
      _setupCompleted = 1;
      return DefaultReturnValue;

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1314
   } else if( PrintOn && getLog() ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1315
      (void) fprintf( getLog(), "%s particles=%d number of bonds=%d maxBonds=%d\n", methodName.c_str(), numberOfParticles, nbondeds, maxBonds );
Mark Friedrichs's avatar
Mark Friedrichs committed
1316
1317
1318
      (void) fflush( getLog() );
   }

Mark Friedrichs's avatar
Latest  
Mark Friedrichs committed
1319
1320
1321
1322
1323
1324
1325
// ---------------------------------------------------------------------------------------

   // charge stream

   _chargeStream             = new BrookFloatStreamInternal( BrookCommon::BondedChargeStream, nbondeds, particleStreamWidth,
                                                             BrookStreamInternal::Float, dangleValue );

1326
// ---------------------------------------------------------------------------------------
Mark Friedrichs's avatar
Mark Friedrichs committed
1327

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1328
   // particle indices stream
Mark Friedrichs's avatar
Mark Friedrichs committed
1329

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1330
1331
   _particleIndicesStream    = new BrookFloatStreamInternal( BrookCommon::BondedParticleIndicesStream, nbondeds, particleStreamWidth,
                                                             BrookStreamInternal::Float4, dangleValue );
Mark Friedrichs's avatar
Mark Friedrichs committed
1332

Mark Friedrichs's avatar
Mark Friedrichs committed
1333
   int* buffer               = new int[4*_particleIndicesStream->getStreamSize()];
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1334
   memset( buffer, 0, sizeof( int )*4*_particleIndicesStream->getStreamSize() );
1335

Mark Friedrichs's avatar
Mark Friedrichs committed
1336
   int index                 = 0;
1337
1338
1339
   for( int ii = 0; ii < nbondeds; ii++ ){
      for( int jj = 0; jj < 4; jj++ ){
         buffer[index++] = ATOMS( ii, jj );
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1340
//(void) fprintf( getLog(), "%s particleIndices %d %d  %d buffer=%d particles=%d\n", methodName.c_str(), ii, jj, index, buffer[index-1], ATOMS( ii, jj ) );
1341
1342
      }
   }
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1343
   _particleIndicesStream->loadFromArray( buffer, BrookStreamInternal::Integer ); 
1344
1345
1346
1347
   delete[] buffer;

// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Mark Friedrichs committed
1348
1349
   _chargeStream->loadFromArray( charges ); 

1350
1351
1352
1353
// ---------------------------------------------------------------------------------------

   // bonded parameters

Mark Friedrichs's avatar
Mark Friedrichs committed
1354
   for( int ii = 0; ii < getNumberOfParameterStreams(); ii++ ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1355
      _bondedParameters[ii]  = new BrookFloatStreamInternal( BrookCommon::BondedParametersStream, nbondeds, particleStreamWidth,
Mark Friedrichs's avatar
Mark Friedrichs committed
1356
                                                             BrookStreamInternal::Float4, dangleValue );
Mark Friedrichs's avatar
Mark Friedrichs committed
1357
1358
1359
      _bondedParameters[ii]->loadFromArray( params[ii] );
   }

1360
1361
// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Mark Friedrichs committed
1362
1363
   // debug stuff

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1364
   if( PrintOn && getLog() ){
Mark Friedrichs's avatar
Mark Friedrichs committed
1365
1366

      (void) fprintf( getLog(), "%s nbondeds=%d strDim [%d %d ] sz=%d\n", methodName.c_str(), nbondeds,
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1367
1368
1369
                      _particleIndicesStream->getStreamWidth(),
                      _particleIndicesStream->getStreamHeight(), 
                      _particleIndicesStream->getStreamSize() );
Mark Friedrichs's avatar
Mark Friedrichs committed
1370
1371
1372
1373
1374
1375
1376
1377
1378
1379
1380
1381
1382
1383
1384
1385
1386
1387
1388
1389
1390
1391
1392
1393

      int kIndex = 0;
      int jIndex = 1;
      int iIndex = 2;
      int lIndex = 3;
      int mIndex = 4;
      
      /*
       * float4 parm0   (rbc[1], rbc[2], rbc[3], rbc[4])
       * float4 parm1   (rbc[5], cp, phi, mult) latter three are for pdih
       * float4 parm2   (theta, k, theta, k ) angles i-j-k and j-k-l
       * float4 parm3   (x0, k, x0, k) bonds i-j, j-k
       * float4 parm4   (x0, k, sig14, eps14) bond k-l, i-l
       */
      
      (void) fprintf( getLog(), "\nParams\n" );
      int index = 0; 
      for( int ii = 0; ii < 4*nbondeds; ii += 4, index++ ){
         //  #define PARAMS(X,Y,Z) (params[(Y)][4*(X) + Z])
         (void) fprintf( getLog(), "\n%4d   [%4d %4d %4d %4d]\n"
                              "     rb[%10.6f %10.6f %10.6f %10.6f %10.6f]\n"
                              "    phi[%10.6f %6.1f %5.1f]\n"
                              "    ang[%6.3f %8.2f] [%6.3f %8.2f]\n"
                              "      h[%8.5f %14.6e] [%8.5f %14.6e] [%8.5f %14.6e]\n"
Mark Friedrichs's avatar
Latest  
Mark Friedrichs committed
1394
                              "     14[%15.6e %15.6e] q14=%15.6e\n", index,
Mark Friedrichs's avatar
Mark Friedrichs committed
1395
1396
1397
1398
1399
                         ATOMS(index, 0), ATOMS(index, 1), ATOMS(index, 2), ATOMS(index, 3),
                         params[kIndex][ii], params[kIndex][ii+1], params[kIndex][ii+2], params[kIndex][ii+3], params[jIndex][ii],
                         params[jIndex][ii+1], params[jIndex][ii+2], params[jIndex][ii+3],
                         params[iIndex][ii], params[iIndex][ii+1], params[iIndex][ii+2], params[iIndex][ii+3], 
                         params[lIndex][ii], params[lIndex][ii+1], params[lIndex][ii+2], params[lIndex][ii+3],
Mark Friedrichs's avatar
Latest  
Mark Friedrichs committed
1400
                         params[mIndex][ii], params[mIndex][ii+1], params[mIndex][ii+2], params[mIndex][ii+3], charges[index] );
Mark Friedrichs's avatar
Mark Friedrichs committed
1401
1402
1403
1404
1405
      }
   }

   // load inverse maps to streams

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1406
   _loadInvMaps( nbondeds, getNumberOfParticles(), particles, particleStreamWidth, particleStreamSize );
Mark Friedrichs's avatar
Mark Friedrichs committed
1407
   
1408
1409
// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Mark Friedrichs committed
1410
1411
1412
1413
1414
   // free memory

   for( int ii = 0; ii < getNumberOfParameterStreams(); ii++ ){
      delete[] params[ii];
   }
1415

Mark Friedrichs's avatar
Mark Friedrichs committed
1416
   delete[] params;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1417
   delete[] particles;
Mark Friedrichs's avatar
Mark Friedrichs committed
1418
1419
1420
1421
1422
   delete[] charges;

   // initialize output streams

   for( int ii = 0; ii < getNumberOfForceStreams(); ii++ ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1423
      _bondedForceStreams[ii] = new BrookFloatStreamInternal( BrookCommon::UnrolledForceStream, nbondeds, particleStreamWidth, 
Mark Friedrichs's avatar
Mark Friedrichs committed
1424
                                                              BrookStreamInternal::Float3, dangleValue );
Mark Friedrichs's avatar
Mark Friedrichs committed
1425
1426
   }

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1427
1428
   _setupCompleted = 1;

Mark Friedrichs's avatar
Mark Friedrichs committed
1429
1430
1431
1432
1433
1434
1435
1436
1437
1438
1439
1440
1441
   return DefaultReturnValue;
}

/* 
 * Get contents of object
 *
 *
 * @param level   level of dump
 *
 * @return string containing contents
 *
 * */

Mark Friedrichs's avatar
Mark Friedrichs committed
1442
std::string BrookBonded::getContentsString( int level ) const {
Mark Friedrichs's avatar
Mark Friedrichs committed
1443
1444
1445

// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Mark Friedrichs committed
1446
   static const std::string methodName      = "BrookBonded::getContentsString";
Mark Friedrichs's avatar
Mark Friedrichs committed
1447
1448
1449
1450
1451
1452
1453
1454
1455
1456
1457
1458
1459
1460
1461
1462
1463
1464
1465

   static const unsigned int MAX_LINE_CHARS = 256;
   char value[MAX_LINE_CHARS];
   static const char* Set                   = "Set";
   static const char* NotSet                = "Not set";

// ---------------------------------------------------------------------------------------

   std::stringstream message;
   std::string tab   = "   ";

#ifdef WIN32
#define LOCAL_SPRINTF(a,b,c) sprintf_s( (a), MAX_LINE_CHARS, (b), (c) );   
#define LOCAL_2_SPRINTF(a,b,c,d) sprintf_s( (a), MAX_LINE_CHARS, (b), (c), (d) );   
#else
#define LOCAL_SPRINTF(a,b,c) sprintf( (a), (b), (c) );   
#define LOCAL_2_SPRINTF(a,b,c,d) sprintf( (a), (b), (c), (d) );   
#endif

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1466
1467
   (void) LOCAL_SPRINTF( value, "%d", getNumberOfParticles() );
   message << _getLine( tab, "Number of particles:", value ); 
Mark Friedrichs's avatar
Mark Friedrichs committed
1468

Mark Friedrichs's avatar
Mark Friedrichs committed
1469
1470
1471
   (void) LOCAL_SPRINTF( value, "%d", getInverseMapStreamWidth() );
   message << _getLine( tab, "Inverse map stream width:", value ); 

Mark Friedrichs's avatar
Mark Friedrichs committed
1472
/*
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1473
1474
   (void) LOCAL_SPRINTF( value, "%d", getParticleStreamWidth() );
   message << _getLine( tab, "Particle stream width:", value ); 
Mark Friedrichs's avatar
Mark Friedrichs committed
1475

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1476
1477
   (void) LOCAL_SPRINTF( value, "%d", getParticleStreamHeight() );
   message << _getLine( tab, "Particle stream height:", value ); 
Mark Friedrichs's avatar
Mark Friedrichs committed
1478

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1479
1480
   (void) LOCAL_SPRINTF( value, "%d", getParticleStreamSize() );
   message << _getLine( tab, "Particle stream size:", value ); 
Mark Friedrichs's avatar
Mark Friedrichs committed
1481
1482
1483
1484
1485
1486
1487
1488
1489
1490
1491
1492
1493
1494
1495
1496
1497
1498
1499
1500
1501
1502
1503
*/

   (void) LOCAL_SPRINTF( value, "%d", getNumberOfParameterStreams() );
   message << _getLine( tab, "Number of parameter streams:", value ); 
   for( int ii = 0; ii < getNumberOfParameterStreams(); ii++ ){
      char description[256];
      (void) LOCAL_SPRINTF( description, "Parameter stream %d", ii );
      message << _getLine( tab, description,  (isParameterStreamSet(ii) ? Set : NotSet) ); 
   }
 
   (void) LOCAL_SPRINTF( value, "%d", getMaxInverseMapStreamCount() )
   message << _getLine( tab, "Max inverseMap count:", value ); 

   for( int ii = 0; ii < getNumberOfForceStreams(); ii++ ){
      char description[256];
      (void) LOCAL_SPRINTF( description, "Inverse map count %d", ii );
      
      std::string checkInverseMap = checkInverseMapStream( ii );
      (void) LOCAL_2_SPRINTF( value, "%d %s", getInverseMapStreamCount( ii ), checkInverseMap.c_str() );
      message << _getLine( tab, description, value ); 
   }

   message << _getLine( tab, "Log:",                 (getLog()               ? Set : NotSet) ); 
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1504
   message << _getLine( tab, "Particle indices stream:", (getParticleIndicesStream() ? Set : NotSet) ); 
Mark Friedrichs's avatar
Mark Friedrichs committed
1505
1506
1507
1508
1509
1510
1511
1512
1513
1514
1515
1516
1517
1518
1519
1520
1521
   //message << _getLine( tab, "Charge stream:",        (getChargeStream()      ? Set : NotSet) ); 
 
   (void) LOCAL_SPRINTF( value, "%d", getNumberOfForceStreams() );
   message << _getLine( tab, "Number of force streams:", value ); 

   for( int ii = 0; ii < getNumberOfForceStreams(); ii++ ){
      char description[256];
      (void) LOCAL_SPRINTF( description, "Force stream %d", ii );
      message << _getLine( tab, description,  (isForceStreamSet(ii) ? Set : NotSet) ); 
   }
 
#undef LOCAL_SPRINTF
#undef LOCAL_2_SPRINTF

   return message.str();
}

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1522
1523
1524
1525
/*
 * Helper functions for building inverse maps for 
 * torsions, impropers and angles.
 * 
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1526
 * For each particle, calculates the positions at which it's
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1527
1528
1529
 * forces are to be picked up from and stores the position
 * in the appropriate index.
 *
Mark Friedrichs's avatar
Mark Friedrichs committed
1530
 * Input: number of torsions, the particle indices, and a flag indicating
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1531
 *        whether we're doing i(0), j(1), k(2) or l(3)
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1532
 * Output: an array of counts per particle
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1533
1534
1535
 *         arrays of inversemaps
 *         nimaps - the number of invmaps actually used.
 *
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1536
1537
 * @param posflag       0-niparticles-1
 * @param niparticles       3 for angles, 4 for torsions, impropers
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1538
 * @param nints         number of interactions
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1539
1540
 * @param nparticles        number of particles
 * @param *particles        gromacs interaction list
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1541
 * @param nmaps         maximum number of inverse maps
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1542
 * @param   counts[]    output counts of how many places each particle occurs
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1543
1544
1545
1546
1547
1548
1549
 * @param *invmaps[]    output array of nmaps inverse maps
 * @param *nimaps,      output max number of inverse maps actually used
 *
 * @return DefaultReturnValue, unless error in which case exits w/ OpenMM exception
 *
 **/

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1550
1551
1552
int BrookBonded::_gpuCalcInvMap( int posflag, int niparticles, int nints, int nparticles,
                                 int *particles, int nmaps, int counts[], float4 *invmaps[],
                                 int *nimaps ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1553
1554
1555
1556

// ---------------------------------------------------------------------------------------

   int i, j;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1557
   int particle;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1558
1559
   int mapnum, mapcomp;

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1560
   static const std::string methodName      = "BrookBonded::_gpuCalcInvMap";
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1561
1562
1563
1564
1565
1566
1567
1568
1569

   static const unsigned int MAX_LINE_CHARS = 256;
   //char value[MAX_LINE_CHARS];
   static const char* Set                   = "Set";
   static const char* NotSet                = "Not set";
   static const int PrintOn                 = 0;

// ---------------------------------------------------------------------------------------

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1570
   memset( counts, 0, sizeof( int )*nparticles );
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1571
1572

   for( i = 0; i < nmaps; i++ ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1573
      for( j = 0; j < nparticles; j++ ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1574
1575
1576
1577
1578
1579
1580
1581
         invmaps[i][j] = float4( -1.0, -1.0, -1.0, -1.0 );
      }
   }
   
   //This will hold the number of imaps actually used

   *nimaps = -1;

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1582
   //Now note down the positions where each particle occurs
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1583
1584

   if( PrintOn && getLog() ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1585
      (void) fprintf( getLog(), "%s: pos=%d ni=%d nints=%d nparticles=%d nmaps=<%d>\n", methodName.c_str(), posflag, niparticles, nints, nparticles, nmaps ); 
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1586
1587
1588
      (void) fflush( getLog() );
   }

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1589
int particleRange[2]   = { 90000000, -90000000 };
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1590
1591
1592
int mapnumRange[2] = { 90000000, -90000000 };

   for(  i = 0; i < nints; i++ ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1593
1594
      //This is our particle
      particle = particles[ (niparticles + 1) * i + posflag + 1 ];
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1595
1596

      //Special for merged bondeds
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1597
      if ( particle == -1 ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1598
1599
1600
         continue;
      }

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1601
1602
if( particle < particleRange[0] ){
   particleRange[0] = particle;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1603
}
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1604
1605
if( particle > particleRange[1] ){
   particleRange[1] = particle;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1606
1607
}
      //Check to make sure we're inside the limits
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1608
      if ( counts[particle] > nmaps * 4 ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1609
         if( PrintOn && getLog() ){
Mark Friedrichs's avatar
Mark Friedrichs committed
1610
            (void) fprintf( getLog(), "%s Particle %d has too many proper torsions (%d, max %d)\n",
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1611
                            methodName.c_str(), particle, counts[particle], nmaps*4 );
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1612
1613
1614
            (void) fflush( getLog() );
         }
         std::stringstream message;
Mark Friedrichs's avatar
Mark Friedrichs committed
1615
         message << methodName << " Particle " << particle << " has too many proper torsions; valid range:(" << counts[particle] << ", " << nmaps*4 << ")";
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1616
1617
1618
1619
1620
         throw OpenMMException( message.str() );
      }
      
      //Which invmap will this go into

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1621
      mapnum = counts[particle] / 4;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1622
1623
1624
1625
1626

      if ( mapnum > *nimaps )
         *nimaps = mapnum;

      //Which component will it be
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1627
      mapcomp = counts[particle] % 4;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1628
1629
1630
1631
1632

      //Set it
      //This is silly, but otherwise I have to declare it as float*
      //and things get even more confusing. :)
      switch (mapcomp){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1633
1634
1635
1636
         case 0: invmaps[mapnum][particle].x = (float) i; break;
         case 1: invmaps[mapnum][particle].y = (float) i; break;
         case 2: invmaps[mapnum][particle].z = (float) i; break;
         case 3: invmaps[mapnum][particle].w = (float) i; break;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1637
1638
1639
1640
1641
1642
1643
1644
1645
1646
1647
         default:
            if( PrintOn && getLog() ){
               (void) fprintf( getLog(), "mapcomp %d invalid -- impossible!\n", mapcomp );
               (void) fflush( getLog() );
            }
            std::stringstream message;
            message << methodName << " mapcomp " << mapcomp << " invalid -- actually impossible!";
            throw OpenMMException( message.str() );
            break;
      }
      
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1648
      counts[particle]++;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1649
1650
1651
1652
1653
1654
1655
1656

if( mapnum < mapnumRange[0] ){
   mapnumRange[0] = mapnum;
}
if( mapnum > mapnumRange[1] ){
   mapnumRange[1] = mapnum;
}

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1657
//fprintf( gpu->log, "%d particle=%d  mapcomp=%d counts[]=%d mapnum=%d\n", i, particle, mapcomp, counts[particle], mapnum );
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1658
1659
1660
1661
1662
1663

   }

   (*nimaps)++;

if( PrintOn && getLog() ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1664
1665
   (void) fprintf( getLog(), "%s mnmaps=%d Ranges: particle [%d %d] mapnum [%d %d]\n",
                   methodName.c_str(), *nimaps, particleRange[0], particleRange[1], mapnumRange[0], mapnumRange[1] );
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1666
1667
1668
1669
1670
1671
1672
   (void) fflush( getLog() );
}

   return DefaultReturnValue;	
}


Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1673
void BrookBonded::_gpuPrintInvMaps( int nmaps, int nparticles, int counts[], float4 *invmap[], FILE* logFile ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1674
1675
   int i;
   int j;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1676
   for(  i = 0; i < nparticles; i++ ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1677
1678
1679
1680
1681
1682
1683
1684
1685
1686
1687
1688
1689
1690
1691
1692
1693
      fprintf( logFile, "%d %d ", i, counts[i] );
      for(  j = 0; j < nmaps; j++ ){
         fprintf( logFile, "%6.0f %6.0f %6.0f %6.0f", invmap[j][i].x, invmap[j][i].y, 
                  invmap[j][i].z, invmap[j][i].w );
      }
      fprintf( logFile, "\n");
   }
}

/* We are still plagued by kernel call overheads. This is for a big fat
 * merged inverse gather kernel:
 * Since we have 32 bit floats, we have 23 bits of mantissa or the largest
 * integer we can represent is 2^23. So it should be quite safe to add 
 * 100000 * n to the index where n is the stream in which we should do the
 * lookup. This assumes that nints < 100000, preferably nints << 100000
 * which should always be true
 * */
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1694

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1695
int BrookBonded::_gpuCalcInvMap_merged( 
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1696
      int nints,    //number of interactions
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1697
1698
      int nparticles,   //number of particles
      int *particles,   //ijkl,ijkl,ijkl...
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1699
      int nmaps,      //maximum number of inverse maps
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1700
        int counts[],   //output counts of how many places each particle occurs
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1701
1702
1703
1704
      float4 *invmaps[], //output array of nmaps inverse maps
      int *nimaps        //output max number of inverse maps actually used
      ){
   int i, j;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1705
   int particle;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1706
1707
1708
   int mapnum, mapcomp;
   int pos;
   
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1709
   for(  i = 0; i < nparticles; i++ )
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1710
1711
1712
      counts[i] = 0;

   for(  i = 0; i < nmaps; i++ ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1713
      for(  j = 0; j < nparticles; j++ ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1714
1715
1716
1717
1718
1719
1720
         invmaps[i][j] = float4( -1.0, -1.0, -1.0, -1.0 );
      }
   }

   //This will hold the number of imaps actually used
   *nimaps = -1;

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1721
   //For each particle
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1722
1723
1724
   for(  i = 0; i < nints; i++ ){
      for(  j = 0; j < 4; j++ ){
         
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1725
         particle = particles[ i * 4 + j ];
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1726
         
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1727
1728
         if ( particle == -1 ){
         	//Nothing to be done for this particle, go to next
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1729
1730
1731
1732
         	continue;
         }
         
         //Which map
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1733
         mapnum = counts[ particle ] / 4;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1734
1735
1736
         
         //Make sure we have space
         if ( mapnum >= nmaps ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1737
1738
         	printf( "Particle %d has too many bondeds(%d, max %d)\n",
         			 particle, counts[particle], nmaps * 4 );
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1739
1740
1741
1742
1743
1744
1745
1746
         	return 0;
         }
         	
         if ( mapnum > *nimaps ){
         	*nimaps = mapnum;
         }

         //Which component
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1747
         mapcomp = counts[ particle ] % 4;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1748
1749
1750
1751
1752
         
         //Encode target stream and position
         pos = 100000 * j + i;

         switch ( mapcomp ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1753
1754
1755
1756
         	case 0: invmaps[mapnum][particle].x = (float) pos; break;
         	case 1: invmaps[mapnum][particle].y = (float) pos; break;
         	case 2: invmaps[mapnum][particle].z = (float) pos; break;
         	case 3: invmaps[mapnum][particle].w = (float) pos; break;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1757
1758
         }

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1759
         counts[ particle ]++;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1760
1761
1762
1763
1764
1765
1766
1767
1768
1769
1770

      }
   }
   
   (*nimaps)++;
   return 1;
}

/* Repacks the invmap streams for more efficient access in the
 * merged inverse gather kernel
 *
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1771
 * buf should be nimaps * nparticles large.
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1772
 * */
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1773
1774
int BrookBonded::_gpuRepackInvMap_merged( int nparticles, int nmaps, int *counts, 
                                          float4 *invmaps[], float4 *buf ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1775
1776
1777
   int i, j;
   int nmaps_i;

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1778
   for(  i = 0; i < nparticles; i++ ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1779
      for(  j = 0; j < nmaps; j++ ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1780
         buf[ i + j*nparticles ] = float4( -1.0f, -1.0f, -1.0f, -1.0f );
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1781
1782
1783
      }
   }
   
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1784
   for(  i = 0; i < nparticles; i++ ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1785
1786
1787
1788
1789
1790
      
      nmaps_i = counts[i] / 4;
      if ( counts[i] % 4 ) 
         nmaps_i++;
      
      for(  j = 0; j < nmaps_i; j++ ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1791
         buf[ i + j * nparticles ] = invmaps[j][i];
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1792
1793
1794
1795
      }
   }
   return 1;
}
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1796
1797
1798
1799
1800
1801
1802
1803
1804
1805
1806
1807
1808
1809
1810
1811
1812
1813

/** 
 * Compute forces
 * 
 */

void BrookBonded::computeForces( BrookStreamImpl& positionStream, BrookStreamImpl& forceStream ){

// ---------------------------------------------------------------------------------------

   static const std::string methodName      = "BrookBonded::computeForces";

   static const int I_Stream                = 0;
   static const int J_Stream                = 1;
   static const int K_Stream                = 2;
   static const int L_Stream                = 3;

   static const int PrintOn                 = 0;
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1814

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1815
1816
1817
1818
1819
1820
1821
1822
1823
1824
1825
   static const int MaxErrorMessages        = 2;
   static       int ErrorMessages           = 0;

   static const float4 dummyParameters( 0.0, 0.0, 0.0, 0.0 );

   // static const int debug                   = 1;

// ---------------------------------------------------------------------------------------

   // bonded

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1826
   float epsfac                                        = (float) (getCoulombFactor());
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1827
1828
1829
1830
1831
1832
1833
1834
1835
1836
1837
1838
1839
1840
1841
1842
1843
1844
1845
1846
1847
1848
1849
1850
1851
1852
1853
1854
1855
1856
1857
1858
1859
1860
1861
1862
   float width                                         = (float) (getInverseMapStreamWidth());

   // bonded forces

   BrookFloatStreamInternal**  bondedParameters        = getBondedParameterStreams();
   BrookFloatStreamInternal**  bondedForceStreams      = getBondedForceStreams();

   BrookFloatStreamInternal**  inverseStreamMaps[4];
   inverseStreamMaps[0]                                = getInverseStreamMapsStreams( 0 );
   inverseStreamMaps[1]                                = getInverseStreamMapsStreams( 1 );
   inverseStreamMaps[2]                                = getInverseStreamMapsStreams( 2 );
   inverseStreamMaps[3]                                = getInverseStreamMapsStreams( 3 );

   kbonded_CDLJ( epsfac, 
                 (float) bondedForceStreams[0]->getStreamWidth(),
                 dummyParameters,
                 positionStream.getBrookStream(),
                 getChargeStream()->getBrookStream(),
                 getParticleIndicesStream()->getBrookStream(),
                 bondedParameters[0]->getBrookStream(),
                 bondedParameters[1]->getBrookStream(),
                 bondedParameters[2]->getBrookStream(),
                 bondedParameters[3]->getBrookStream(),
                 bondedParameters[4]->getBrookStream(),
                 bondedForceStreams[0]->getBrookStream(),
                 bondedForceStreams[1]->getBrookStream(),
                 bondedForceStreams[2]->getBrookStream(),
                 bondedForceStreams[3]->getBrookStream() );


   // diagnostics

   if( 1 && PrintOn ){

      int countPrintInvMap[4] = { 3, 5, 2, 4 }; 

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1863
      (void) fprintf( getLog(), "\nPost kbonded_CDLJ: epsFac=%.6f %.6f", epsfac, getCoulombFactor());
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1864
1865
1866
1867
1868
1869
1870
1871
1872
1873
1874
1875
1876
1877
1878
1879
1880
1881
1882
1883
1884
      (void) fprintf( getLog(), "\nParticle indices stream\n" );
      getParticleIndicesStream()->printToFile( getLog() );

      (void) fprintf( getLog(), "\nCharge stream\n" );
      getChargeStream()->printToFile( getLog() );

      for( int ii = 0; ii < 5; ii++ ){
         (void) fprintf( getLog(), "\nParam stream %d\n", ii );
         bondedParameters[ii]->printToFile( getLog() );
      }
      for( int ii = 0; ii < 4; ii++ ){
         (void) fprintf( getLog(), "\nForce stream %d\n", ii );
         bondedForceStreams[ii]->printToFile( getLog() );
      }

/*
      (void) fprintf( getLog(), "\nNB1 forces" );
      BrookStreamInternal* brookStreamInternalF   = forceStream.getBrookStreamImpl();
      brookStreamInternalF->printToFile( getLog() );
*/

Mark Friedrichs's avatar
Mark Friedrichs committed
1885
      (void) fprintf( getLog(), "\nInverse map streams\n" );
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1886
      for( int ii = 0; ii < 4; ii++ ){
Mark Friedrichs's avatar
Mark Friedrichs committed
1887
         (void) fprintf( getLog(), "\nInverse map streams -- StreamIndex=%d cnt=%d\n", ii, getInverseMapStreamCount( ii ) );
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1888
1889
1890
1891
1892
1893
1894
1895
1896
1897
1898
1899
1900
1901
1902
1903
1904
1905
1906
1907
1908
1909
1910
1911
1912
         for( int jj = 0; jj < countPrintInvMap[ii]; jj++ ){
            (void) fprintf( getLog(), "\n   Inverse map streams index=%d %d\n", ii, jj );
            inverseStreamMaps[ii][jj]->printToFile( getLog() );
         }
      }
   }

   // gather forces

   if( getInverseMapStreamCount( I_Stream ) == 3 && getInverseMapStreamCount( K_Stream ) == 3 ){

      kinvmap_gather3_3( width,

                         inverseStreamMaps[I_Stream][0]->getBrookStream(),
                         inverseStreamMaps[I_Stream][1]->getBrookStream(),
                         inverseStreamMaps[I_Stream][2]->getBrookStream(),
                         bondedForceStreams[I_Stream]->getBrookStream(),

                         inverseStreamMaps[K_Stream][0]->getBrookStream(),
                         inverseStreamMaps[K_Stream][1]->getBrookStream(),
                         inverseStreamMaps[K_Stream][2]->getBrookStream(),
                         bondedForceStreams[K_Stream]->getBrookStream(),

                         forceStream.getBrookStream(), forceStream.getBrookStream() );

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1913
1914
1915
1916
1917
1918
1919
1920
1921
1922
1923
1924
1925
1926
   } else if( getInverseMapStreamCount( I_Stream ) == 2 && getInverseMapStreamCount( K_Stream ) == 2 ){

      kinvmap_gather2_2( width,

                         inverseStreamMaps[I_Stream][0]->getBrookStream(),
                         inverseStreamMaps[I_Stream][1]->getBrookStream(),
                         bondedForceStreams[I_Stream]->getBrookStream(),

                         inverseStreamMaps[K_Stream][0]->getBrookStream(),
                         inverseStreamMaps[K_Stream][1]->getBrookStream(),
                         bondedForceStreams[K_Stream]->getBrookStream(),

                         forceStream.getBrookStream(), forceStream.getBrookStream() );

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1927
1928
1929
1930
1931
1932
1933
1934
1935
1936
1937
1938
1939
1940
1941
1942
1943
1944
1945
1946
1947
1948
1949
1950
1951
1952
1953
1954
1955
1956
1957
1958
   } else if( getInverseMapStreamCount( I_Stream ) == 3 && getInverseMapStreamCount( K_Stream ) == 4 ){

      kinvmap_gather3_4( width,

                         inverseStreamMaps[I_Stream][0]->getBrookStream(),
                         inverseStreamMaps[I_Stream][1]->getBrookStream(),
                         inverseStreamMaps[I_Stream][2]->getBrookStream(),
                         bondedForceStreams[I_Stream]->getBrookStream(),

                         inverseStreamMaps[K_Stream][0]->getBrookStream(),
                         inverseStreamMaps[K_Stream][1]->getBrookStream(),
                         inverseStreamMaps[K_Stream][2]->getBrookStream(),
                         inverseStreamMaps[K_Stream][3]->getBrookStream(),
                         bondedForceStreams[K_Stream]->getBrookStream(),

                         forceStream.getBrookStream(), forceStream.getBrookStream() );

   } else if( getInverseMapStreamCount( I_Stream ) == 3 && getInverseMapStreamCount( K_Stream ) == 5 ){

      kinvmap_gather3_5( width,
                         inverseStreamMaps[I_Stream][0]->getBrookStream(),
                         inverseStreamMaps[I_Stream][1]->getBrookStream(),
                         inverseStreamMaps[I_Stream][2]->getBrookStream(),
                         bondedForceStreams[I_Stream]->getBrookStream(),
                         inverseStreamMaps[K_Stream][0]->getBrookStream(),
                         inverseStreamMaps[K_Stream][1]->getBrookStream(),
                         inverseStreamMaps[K_Stream][2]->getBrookStream(),
                         inverseStreamMaps[K_Stream][3]->getBrookStream(),
                         inverseStreamMaps[K_Stream][4]->getBrookStream(),
                         bondedForceStreams[K_Stream]->getBrookStream(),
                         forceStream.getBrookStream(), forceStream.getBrookStream() );

Mark Friedrichs's avatar
Mark Friedrichs committed
1959
1960
1961
1962
1963
1964
1965
1966
1967
   } else if( getInverseMapStreamCount( I_Stream ) == 1 && getInverseMapStreamCount( K_Stream ) == 1 ){

      kinvmap_gather1_1( width,
                         inverseStreamMaps[I_Stream][0]->getBrookStream(),
                         bondedForceStreams[I_Stream]->getBrookStream(),
                         inverseStreamMaps[K_Stream][0]->getBrookStream(),
                         bondedForceStreams[K_Stream]->getBrookStream(),
                         forceStream.getBrookStream(), forceStream.getBrookStream() );

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1968
1969
1970
1971
   } else {

      // case not handled -- throw an exception

Mark Friedrichs's avatar
Mark Friedrichs committed
1972
      if( getLog() && ErrorMessages++ < MaxErrorMessages && getInverseMapStreamCount( I_Stream ) > 0 && getInverseMapStreamCount( K_Stream ) > 0 ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
1973
1974
1975
1976
1977
1978
1979
1980
1981
1982
1983
1984
1985
1986
1987
1988
1989
1990
1991
1992
1993
1994
1995
1996
1997
1998
1999
2000
2001
2002
2003
2004
2005
2006
2007
2008
2009
2010
         (void) fprintf( getLog(), "%s case: I-map=%d K-map=%d -- not handled.\n",
                          methodName.c_str(), getInverseMapStreamCount( I_Stream ),
                                              getInverseMapStreamCount( K_Stream ) );
         (void) fflush(  getLog() );
      }

      kinvmap_gather3_3( width,

                         inverseStreamMaps[I_Stream][0]->getBrookStream(),
                         inverseStreamMaps[I_Stream][1]->getBrookStream(),
                         inverseStreamMaps[I_Stream][2]->getBrookStream(),
                         bondedForceStreams[I_Stream]->getBrookStream(),

                         inverseStreamMaps[K_Stream][0]->getBrookStream(),
                         inverseStreamMaps[K_Stream][1]->getBrookStream(),
                         inverseStreamMaps[K_Stream][2]->getBrookStream(),
                         bondedForceStreams[K_Stream]->getBrookStream(),

                         forceStream.getBrookStream(), forceStream.getBrookStream() );
/*
      std::stringstream message;
      message << methodName << "I-maps=" << getInverseMapStreamCount( I_Stream ) << " and " << 
                               "K-maps=" << getInverseMapStreamCount( K_Stream ) << " not handled.";
      throw OpenMMException( message.str() );
*/

   }

   // diagnostics

   if( 0 && PrintOn ){

      (void) fprintf( getLog(), "\nPost 3_4/3_5 && NB forces" );
      BrookStreamInternal* brookStreamInternalF   = forceStream.getBrookStreamImpl();
      brookStreamInternalF->printToFile( getLog() );

   }

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
2011
2012
2013
2014
2015
2016
2017
2018
2019
2020
2021
   if( getInverseMapStreamCount( J_Stream ) == 1 && getInverseMapStreamCount( L_Stream ) == 1 ){

      kinvmap_gather1_1( width,
                         inverseStreamMaps[J_Stream][0]->getBrookStream(),
                         bondedForceStreams[J_Stream]->getBrookStream(),
                         inverseStreamMaps[L_Stream][0]->getBrookStream(),
                         bondedForceStreams[L_Stream]->getBrookStream(),
                         forceStream.getBrookStream(), forceStream.getBrookStream() );
   
   } else if( getInverseMapStreamCount( J_Stream ) == 5 && getInverseMapStreamCount( L_Stream ) == 2 ){

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
2022
2023
2024
2025
2026
2027
2028
2029
2030
2031
2032
2033
2034
2035
2036
2037
      kinvmap_gather5_2( width,
                         inverseStreamMaps[J_Stream][0]->getBrookStream(),
                         inverseStreamMaps[J_Stream][1]->getBrookStream(),
                         inverseStreamMaps[J_Stream][2]->getBrookStream(),
                         inverseStreamMaps[J_Stream][3]->getBrookStream(),
                         inverseStreamMaps[J_Stream][4]->getBrookStream(),
                         bondedForceStreams[J_Stream]->getBrookStream(),
                         inverseStreamMaps[L_Stream][0]->getBrookStream(),
                         inverseStreamMaps[L_Stream][1]->getBrookStream(),
                         bondedForceStreams[L_Stream]->getBrookStream(),
                         forceStream.getBrookStream(), forceStream.getBrookStream() );
   
   } else {

      // case not handled -- throw an exception

Mark Friedrichs's avatar
Mark Friedrichs committed
2038
      if( getLog() && ErrorMessages++ < MaxErrorMessages && getInverseMapStreamCount( J_Stream ) > 0 && getInverseMapStreamCount( L_Stream ) > 0 ){
Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
2039
2040
2041
2042
2043
2044
         (void) fprintf( getLog(), "%s case: J-map=%d L-map=%d -- not handled.\n",
                          methodName.c_str(), getInverseMapStreamCount( J_Stream ),
                                              getInverseMapStreamCount( L_Stream ) );
         (void) fflush(  getLog() );
      }

Mark Friedrichs's avatar
Mark Friedrichs committed
2045
2046
2047
      // this is for testing purposes a-- may need to be cleaned 
      // or add new gather functions

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
2048
2049
2050
2051
2052
2053
2054
2055
2056
2057
2058
      kinvmap_gather5_2( width,
                         inverseStreamMaps[J_Stream][0]->getBrookStream(),
                         inverseStreamMaps[J_Stream][1]->getBrookStream(),
                         inverseStreamMaps[J_Stream][2]->getBrookStream(),
                         inverseStreamMaps[J_Stream][3]->getBrookStream(),
                         inverseStreamMaps[J_Stream][4]->getBrookStream(),
                         bondedForceStreams[J_Stream]->getBrookStream(),
                         inverseStreamMaps[L_Stream][0]->getBrookStream(),
                         inverseStreamMaps[L_Stream][1]->getBrookStream(),
                         bondedForceStreams[L_Stream]->getBrookStream(),
                         forceStream.getBrookStream(), forceStream.getBrookStream() );
Mark Friedrichs's avatar
Mark Friedrichs committed
2059

Mark Friedrichs's avatar
Mods  
Mark Friedrichs committed
2060
2061
2062
2063
2064
2065
2066
2067
2068
2069
2070
2071
2072
2073
2074
2075
2076
2077
2078
2079
2080
2081
2082
2083
2084
2085
2086
2087
2088
/*
      std::stringstream message;
      message << methodName << "J-maps=" << getInverseMapStreamCount( J_Stream ) << " and " << 
                               "L-maps=" << getInverseMapStreamCount( L_Stream ) << " not handled.";
      throw OpenMMException( message.str() );
*/

   }

   // diagnostics

   if( 1 && PrintOn ){

      (void) fprintf( getLog(), "\nFinal NB & bonded forces" );
      BrookStreamInternal* brookStreamInternalF   = forceStream.getBrookStreamImpl();
      brookStreamInternalF->printToFile( getLog() );
/*
      void* dataV = brookStreamInternalF->getData(1);
      float* data = (float*) dataV;
      (void) fprintf( getLog(), "\nFinal NB & bonded forces RAW\n" );
      for( int ii = 0; ii < _brookNonBonded->getNumberOfParticles()*3; ii += 3 ){
         (void) fprintf( getLog(), "%d [%.6e %.6e %.6e]\n", ii, data[ii], data[ii+1], data[ii+2] );
      }
*/

   }

   // ---------------------------------------------------------------------------------------
}