Methods, systems and devices for estimating the position and orientation of an invasive surgical devices, for example, a catheter guidewire or endoscope, surgical catheter, or self-guided electrophysiology catheter, relative to a reference frame, are described. An example system comprises one or more permanent magnets mounted on the surgical device, a plurality of magnetometer sensors at fixed location providing a reference frame that are configured to perform magnetic field measurements of the direct current superposition field of the permanent magnets, and computational means for receiving the input signals and calculating the position and orientation of the permanent magnets mounted on the surgical device.