AngleConstraint.h 2.22 KB
Newer Older
1 2 3 4 5
////////////////////////////////////////////////////////////////////////////////
//
//  AngleConstraint.h
//
////////////////////////////////////////////////////////////////////////////////
Francois Gygi committed
6
// $Id: AngleConstraint.h,v 1.2 2005-09-16 23:08:11 fgygi Exp $
7 8 9 10 11 12 13 14 15 16 17 18 19 20

#ifndef ANGLECONSTRAINT_H
#define ANGLECONSTRAINT_H

#include "Constraint.h"
#include "D3vector.h"
#include <cassert>
class AtomSet;

class AngleConstraint : public Constraint
{
  string name1_, name2_, name3_;
  int    ia1_, ia2_, ia3_, is1_, is2_, is3_;
  double m1_, m2_, m3_, m1_inv_, m2_inv_, m3_inv_;
Francois Gygi committed
21
  double angle_, velocity_, force_, weight_, tol_;
22 23 24 25 26 27 28
  double sigma(D3vector a, D3vector b, D3vector c) const;
  void grad_sigma(const D3vector &r1, const D3vector &r2, const D3vector &r3,
                  D3vector &g1, D3vector &g2,D3vector &g3) const;
  double bond_angle(D3vector a, D3vector b, D3vector c) const;
  
  public:
  
Francois Gygi committed
29
  AngleConstraint(string name, string name1, string name2, string name3,
30 31 32 33 34 35
                     double angle, double velocity, double tolerance):
  name1_(name1), name2_(name2), name3_(name3), 
  velocity_(velocity),
  tol_(tolerance), m1_(0.0), m2_(0.0), m3_(0.0)
  { 
    set_value(angle);
Francois Gygi committed
36
    name_ = name;
37 38 39 40
    names_.resize(3);
    names_[0] = name1_;
    names_[1] = name2_;
    names_[2] = name3_;
Francois Gygi committed
41 42
    force_ = 0.0;
    weight_ = 1.0;
43 44 45 46 47
  }
  
  string type(void) const { return "angle"; }
  double value(void) const { return angle_; }
  double velocity(void) const { return velocity_; }
Francois Gygi committed
48 49
  double force(void) const { return force_; }
  double weight(void) const { return weight_; }
50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67
  double tolerance(void) const { return tol_; }
  void set_value(double value)
  {
    angle_ = value;
    if ( angle_ <   0.0 ) angle_ =   0.0;
    if ( angle_ > 180.0 ) angle_ = 180.0;
  }
  void set_velocity(double velocity)
  {
    velocity_ = velocity;
  }
  
  void setup(const AtomSet& atoms);
  void update(double dt);
  bool enforce_r(const vector<vector<double> > &r0,
                 vector<vector<double> > &rp) const;
  bool enforce_v(const vector<vector<double> > &r0,
                 vector<vector<double> > &v0) const;
Francois Gygi committed
68 69
  void compute_force(const vector<vector<double> > &r0,
                     const vector<vector<double> > &f);
70 71 72 73
  ostream& print( ostream& os );
  
};
#endif