Avoid exceeding joint limit, communication with real robot (not actually working yet)