Matlab code for dh table