Speed

now fully working with a cycle time of < 25ms for calcEnergyAndDerivs averaged over 11 calls