39 data =
new double[size];
47 data = ((0 < size) ?
new double[size] :
NULL);
48 for(
unsigned int i=0;i<size;i++)
54 assert(size==arg.size);
55 for(
unsigned int i=0;i<size;i++)
70 data =
new double[size];
105 assert(src1.size==src2.size&&src1.size==
dest.size);
106 for(
unsigned int i=0;i<
dest.size;i++)
107 dest.data[i]=src1.data[i]+src2.data[i];
112 assert(src1.size==src2.size&&src1.size==
dest.size);
113 for(
unsigned int i=0;i<
dest.size;i++)
114 dest.data[i]=src1.data[i]-src2.data[i];
120 for(
unsigned int i=0;i<
dest.size;i++)
121 dest.data[i]=factor*
src.data[i];
127 for(
unsigned int i=0;i<
dest.size;i++)
128 dest.data[i]=
src.data[i]/factor;
135 for(
unsigned int i=0;i<6;i++)
136 for(
unsigned int j=0;j<
src.size;j++)
148 assert(src1.size==src2.size);
150 for(
unsigned int i=0;i<src1.size;i++)
static DBVT_INLINE btScalar size(const btDbvtVolume &a)
unsigned int columns() const
double * operator()(unsigned int i)
unsigned int rows() const
friend void SetToZero(JntArray &array)
JntArray & operator=(const JntArray &arg)
void resize(unsigned int newSize)
double operator[](unsigned int i) const
unsigned int columns() const
represents both translational and rotational velocities.
SyclQueue void void * src
bool operator==(const Rotation &a, const Rotation &b)
void Add(const JntArray &src1, const JntArray &src2, JntArray &dest)
void Divide(const JntArray &src, const double &factor, JntArray &dest)
void Multiply(const JntArray &src, const double &factor, JntArray &dest)
void SetToZero(Jacobian &jac)
void Subtract(const JntArray &src1, const JntArray &src2, JntArray &dest)
void MultiplyJacobian(const Jacobian &jac, const JntArray &src, Twist &dest)
IMETHOD bool Equal(const VectorAcc &, const VectorAcc &, double=epsilon)