switched motion correction to gradient descent
fixed an Eigen warning and removed some debugs