This paper presents a novel method for ultrasound speed compensation in ultrasonic robot tracking. It employs optimization algorithms to estimate the best value of the ultrasound speed for every computation of the robot end-effector position. Compared with the other existing method for ultrasound speed compensation, this method has the advantage that no extra equipment is required to monitor the environment conditions (temperature etc.). The simulation, which is described at the end of this paper, shows that the real trajectory is extracted with very good precision from a set of distorted data caused by serious ultrasound speed drifting.