An approach to motion planning and motion control of two robots in a common workplace