added a force feed back code that uses the laser msgs instead of the point cloud msgs