Optimized force calculation a bit and added multi-threading capability.