Cleaned up the kinect force calculation