Are you sure the measurements are correct?

Hello, I measured length of the links and joint locations, so i think that you modelled robot in a wrong way. Lengths aren't the same as the original one. for example second joint shnould be placed from ground 0.075 meters away instead of 0.0425. @adeguet1 