There are some 79 or so Matlab files here which will help in many aspects of the computer vision structure from motion problem, a full description is provided in the manual, torrsam.ps.