More FM methods added

I see a very strange workflow here, maxVelocityRobot == -1 then solveEikonal(...,star) else, if (star)... very confusing.