Optimize the heavily loaded loops

The force calculation function and leapfrog functions should be optimized since they are what is taking the most time in our program (especially force calculation). Right now unnecessary parameters are calculated in those loops, which could probably be calculated somewhere else.
