Multipath Compensation Algorithm for TDMA-Based Ultrasonic Local Positioning Systems