3D Torque + some

Rewrote the force along a line functions and added a coordinates to
vector function and as a result I was able to add 3D torque support!