Implement energy minimization
Minimize energy, speedup
Speedup energy calculation
Speedup force calculation
Simplify
Expose more variables to the caller