MATLAB tools to create trajectories for MAESTRO from start and end xyz positions of HUBO's arms and legs