Added Hubo ankle/knee test code