Ultrasound Based Navigation and Control for Orthopaedic Robot Surgery