Robot manipulation under joint and obstacle constraints