Corrected the force finding maths

Also added ability to add nodes by pressing any key.