file = [];
opt.robot_def = 'direct';
opt.KM_method = 'MDH';
opt.LD_method = 'direct';

robot = get_robot(file,opt);
robot.theta = [1,1,0];
robot = get_Kinematics(robot, opt);

robot = get