added robot model and frame transfomation