Fixed error in force calculation inside self box. Did optimization.