1) Fixed bugs in linear solver 2)test_f computes focal length