[Python] Updating Python tests to corresponds to the API ( e.g we add frames for every link and joint we encounter in urdf )