A system and method that compensates for local disturbances in magnetometer measurements for working equipment. For example, compensating for magnetometer disturbances caused by a stick, boom, and bucket of an excavator. The compensation is performed by generating or obtaining a magnetic model of movable members, determining the position of each of the movable members, calculating an estimated magnetic disturbance, and modifying the magnetometer measurement.