RealOpenMM**velData=const_cast<RealOpenMM**>(((BrookFloatStreamImpl&)velocities.getImpl()).getData());// Brook code needs to be made const correct
doubleenergy=0.0;
/*
RealOpenMM** velData = const_cast<RealOpenMM**>(((BrookFloatStreamImpl&) velocities.getImpl()).getData()); // Brook code needs to be made const correct
for (int i = 0; i < masses.size(); ++i)
energy += masses[i]*(velData[i][0]*velData[i][0]+velData[i][1]*velData[i][1]+velData[i][2]*velData[i][2]);