<!DOCTYPE article PUBLIC "-//NLM//DTD JATS (Z39.96) Journal Archiving and Interchange DTD v1.0 20120330//EN" "JATS-archivearticle1.dtd">
<article xmlns:xlink="http://www.w3.org/1999/xlink">
  <front>
    <journal-meta>
      <issn pub-type="ppub">1613-0073</issn>
    </journal-meta>
    <article-meta>
      <title-group>
        <article-title>Motion Planning for Manufacturing Processes</article-title>
      </title-group>
      <contrib-group>
        <contrib contrib-type="author">
          <string-name>Alberto Gottardi</string-name>
          <email>alberto.gottardi@it-robotics.it</email>
          <xref ref-type="aff" rid="aff0">0</xref>
        </contrib>
        <contrib contrib-type="author">
          <string-name>Nicola Castaman</string-name>
          <xref ref-type="aff" rid="aff1">1</xref>
        </contrib>
        <contrib contrib-type="author">
          <string-name>Enrico Pagello</string-name>
          <email>enrico.pagello@unipd.it</email>
        </contrib>
        <contrib contrib-type="author">
          <string-name>Emanuele Menegatti</string-name>
          <email>emanuele.menegatti@unipd.it</email>
          <xref ref-type="aff" rid="aff0">0</xref>
        </contrib>
        <contrib contrib-type="editor">
          <string-name>Task and Motion Planning, Human-Robot Collaboration</string-name>
        </contrib>
        <aff id="aff0">
          <label>0</label>
          <institution>Intelligent Autonomous System Lab, Dept. of Information Engineering, University of Padova</institution>
          ,
          <addr-line>35131 Padua</addr-line>
          ,
          <country country="IT">Italy</country>
        </aff>
        <aff id="aff1">
          <label>1</label>
          <institution>Professional Industrial consultant</institution>
          ,
          <addr-line>36061 Bassano del Grappa</addr-line>
          ,
          <country country="IT">Italy</country>
        </aff>
        <aff id="aff2">
          <label>2</label>
          <institution>Robotics srl</institution>
          ,
          <addr-line>36100 Vicenza</addr-line>
          ,
          <country country="IT">Italy</country>
        </aff>
      </contrib-group>
      <abstract>
        <p>The synergy between the robot's abilities and human expertise provides several advantages in the industrial processes. A proper integration of Task and Motion Planning (TAMP), considering the interaction of the user with the environment is essential to maximize the benefits of robot-assisted tasks and to ensure safety in collaborative H-R tasks. However, the state of the art of the TAMP research ifeld should be improved to overcome the limitations of the traditional TAMP approaches to be used in industrial scenarios. We illustrate a list of challenges to be solved in order to improve to manage eficiently the dynamism and uncertainty given by introducing a human operator into a robotized process of draping fiber carbon plies, with reference to the granted European Project DrapeBot. Finally, the proposed TAMP architecture is presented to address the challenges described.</p>
      </abstract>
    </article-meta>
  </front>
  <body>
    <sec id="sec-1">
      <title>-</title>
      <p>CEUR
ceur-ws.org</p>
    </sec>
    <sec id="sec-2">
      <title>1. Introduction</title>
      <p>
        Human-Robot Collaboration (HRC) has emerged as a significant technological challenge in the
industrial landscape in recent years. By combining the precision, eficiency, and repeatability
of robots with the intelligence, adaptability and expertise of humans, numerous advantages
emerge. Such collaboration reduces operator fatigue, improves ergonomic conditions, and
enhances production quality [
        <xref ref-type="bibr" rid="ref1 ref2">1, 2</xref>
        ]. The robot must continuously interpret human interventions
in order to adapt to a cooperative performance while it is executing the task plan [
        <xref ref-type="bibr" rid="ref3">3</xref>
        ]. Proper
integration of Task and Motion Planning (TAMP) [
        <xref ref-type="bibr" rid="ref4">4</xref>
        ], considering both the environment and
user needs is essential to maximise the benefits of robot-assisted tasks and to ensure safety in
collaborative tasks.
      </p>
      <p>
        A common technique in TAMP is interleaving the symbolic and geometric search processes
by calling a motion planner at each step and assigning geometric parameters to the currently
symbolic state before proceeding. The interleaving becomes problematic when a planned state is
LGOBE
(E. Menegatti)
valid in symbolic space, but geometrically infeasible. To address this, FFRob [
        <xref ref-type="bibr" rid="ref5">5</xref>
        ] introduced an
FFlike heuristic that integrates geometric information into the FF-search. An alternative approach
executes a geometric search on candidate symbolic plans [
        <xref ref-type="bibr" rid="ref6">6</xref>
        ]. Similarly, Dantam et al. [
        <xref ref-type="bibr" rid="ref7">7</xref>
        ]
incrementally generate symbolic plans using an incremental Satisfiable Modulo Theory solver,
invoking a motion planner for validation. Most TAMP methods have long processing times and
consider a static environment, assuming an ideal, noise-free perception system. Nouman et al. [
        <xref ref-type="bibr" rid="ref8">8</xref>
        ]
proposed a hybrid condition planner that extends the classical condition planner by integrating
feasibility checks into the action conditions. Castaman et al. [
        <xref ref-type="bibr" rid="ref9">9</xref>
        ] solve TAMP problems in a
changing environment with a receding horizon approach, iteratively solving a reduced planning
problem over a receding window. A preliminary study on a conditional TAMP algorithm able
to find a plan that minimizes robot eforts while solving assigned tasks has also been illustrated
in [
        <xref ref-type="bibr" rid="ref10">10</xref>
        ]. In [
        <xref ref-type="bibr" rid="ref11">11</xref>
        ] Lagrifoul et al. have presented a platform-independent evaluation method for
TAMP by proposing a set of benchmark problems covering the challenging aspects of TAMP.
However, these approaches do not completely satisfy the requirements: most TAMP methods
have long processing times and consider a static environment, assuming an ideal, noise-free
perception system. A second limitation of these works is that they do not consider the human
operator, a crucial element in the industrial application under analysis.
      </p>
    </sec>
    <sec id="sec-3">
      <title>2. Case Study</title>
      <p>
        Since an industrial environment shared by humans and robots is a highly dynamic scenario,
many manufacturing industries have not yet introduced automation in their processes. The
unpredictability of human presence must be integrated into TAMP and robot control, leveraging
the latest advances in perception and interactions. Thus, this paper ofers an enhanced approach
that could solve the challenges outlined below for manufacturing processes of an industrial HRC
scenario. The following list of challenges was initially identified from the author’s experience
in the industrial environment and previous works [
        <xref ref-type="bibr" rid="ref10 ref2 ref9">2, 9, 10</xref>
        ]. The requirements of the industrial
environment provided by the application of draping within the Drapebot project emphasised
the importance of addressing these challenges with a TAMP approach.
      </p>
      <p>CHL1 To integrate the knowledge of humans’ and robots’ capabilities
CHL2 To compute feasible action sequences and share them among humans and robots
CHL3 To satisfy ergonomic constraints by synchronizing robot and human movements
CHL4 To ensure human safety during robot motion
CHL5 To continuously monitor the scene by adapting on-line the robot to changes</p>
      <p>These five challenges can be grouped into three macro categories: collaboration (CHL1-3),
safety (CHL4) and monitoring (CHL5). Firstly, CHL1 calls for the seamless integration of human
and robot capabilities, emphasizing the need to harness their expertise efectively. CHL2 extends
this by highlighting the intricate task of computing a viable action sequence and facilitating its
sharing between human and robot counterparts, which is pivotal for synchronized and eficient
collaboration. CHL3 complements these by emphasizing the ergonomic alignment of robot
movements with human actions, particularly vital in cooperative endeavours involving physical
interaction. Moving on to safety, CHL4 addresses the paramount issue of ensuring human
safety throughout robot motion, necessitating robust safety mechanisms and real-time risk
assessment. Last, the theme of monitoring comes to the fore with CHL5, stressing the robot’s
continuous scene observation and adaptive response capabilities to address environmental
changes proactively.</p>
      <p>
        We have tackled the above challenges within the EU project DrapeBot (https://www.drapebot.
eu/), aiming to develop an HRC system that aids operators in carbon fiber draping. In particular,
it focuses on the dynamic scheduling of shared human-robot activities within a manufacturing
environment where humans and robots collaborate to complete complex tasks like draping [
        <xref ref-type="bibr" rid="ref12">12</xref>
        ].
      </p>
    </sec>
    <sec id="sec-4">
      <title>3. Framework Concept</title>
      <p>In HRC industrial applications, the TAMP framework is pivotal. It must ensure flexibility in
managing work plans, efectively address operator interventions, handle inputs from external
sensors (e.g., perception systems and laser scanners), and safeguard operator safety. Furthermore,
it should maintain production quality by automating inspection processes for quality control.
The use of a TAMP indeed allows the industrial process to take a step forward, bringing an
increase in productivity and more eficient use of resources and operator skills by removing the
operator from more stressful and repetitive tasks (e.g. transporting patches, in-depth inspection
during the process). Therefore, one specific industrial scenario where a human-aware TAMP
solution can play a critical role is inside the carbon fiber draping process. Draping involves
transporting the carbon ply onto the mould and shaping it to fit. Another vital process is
visual inspection to ensure product quality. This process is predominantly manual, carried out
by skilled human operators whose expertise is essential for the final product’s high quality.
Employing TAMP lets the operator be more free to focus on the draping activity, which is the
one that requires the highest skill to obtain the best final quality of the product. Thus, being
draping an excellent case for attempting to address the illustrated challenges of a dynamic
human-aware industrial scenario, we are developing a TAMP approach within the DrapeBot
project according to the approach outlined by (Fig. 2). Our proposed framework comprises
three main modules: Task Planner, Motion Planner and Central Node.</p>
      <p>
        Task Planner. The Task Planner [
        <xref ref-type="bibr" rid="ref13">13</xref>
        ] orchestrates the operations of humans and robots.
It generates a continuously updated plan that will serve as a workflow guideline and consist
of the sequence of actions to complete the assigned task. The Task Planner handles human
interrupts, dynamically adjusting the computed plan to satisfy collaboration needs or to deal
with unexpected events (CHL1, CHL2). Additionally, it employs recovery procedures to revert
to a safe state. Since the planner has to deal with diferent agents, the efort must be divided in
such a way that the robot maximizes its contribution and takes care of the heaviest actions (e.g.,
inspection, small plies transportation) so that the user can minimize his efort and concentrate
more on the activity of draping the ply on the mould (CHL2). The details of the approach and
the efort graph-based algorithm are described in [
        <xref ref-type="bibr" rid="ref13">13</xref>
        ].
      </p>
      <p>A three-tier hierarchical design enhances modularity and adaptability:
• Primitive actions: Fundamental operations (e.g., Move, Draping, Inspection, etc.).
• Composite actions: Sequences of primitives for complex actions like patch transportation,
involving robot movement, carbon fiber detection, etc.
• Final Plan: Provides a high-level view of the draping process by laying out the entire
sequence of tasks for both human and robot agents.</p>
      <p>
        Motion Planner. The Motion Planner computes collision-free trajectory for robots. To
ensure operator safety (CHL4), Safe Zones are introduced to restrict robot entry, assuring
operator freedom. Motion planning algorithm considers these zones to compute non-collaborative
motions (Fig. 1). The collaborative trajectory is the most challenging to compute. The
planner must consider human limitations, emphasizing ergonomic constraints based on operator
stature (CHL3). Figure 3 displays the window for the cost function of human operations while
cooperating with the robot. A skeletal tracking system [
        <xref ref-type="bibr" rid="ref14">14</xref>
        ] makes it possible to compute an
ergonomic trajectory that all agents can execute.
      </p>
      <p>Central Node. In the classical approaches, Task and Motion planner modules communicate
directly to exchange information. However, due to the large amount of data to be handled
from the industrial scene and process, our framework provides a Central Node to integrate
and optimize task and motion planner modules. The plan is carried out by the Central Node,
which also controls and supervises the proper primitives’ activity. Additionally, this module
constantly monitors the condition of the workcell using the sensors in the environment (CHL5).
The Central Node also handles human gestures that trigger action not foreseen in the plan
(CHL1). In that case, it sends the information to the Task Planner module which is in charge of
creating a new plan where the requested action is the first action to be performed.</p>
    </sec>
    <sec id="sec-5">
      <title>4. Conclusions</title>
      <p>To improve the management of a dynamic and uncertain scenario by introducing a human
cooperating with a robot in an industrial process, we consider the limits of the current state
of the art of TAMP approaches. We list a series of challenges that should be addressed, like
integrating human skills with robot flexibility, the ergonomic constraints due to the operator’s
physical body, the workers’ safety issues, and the processes’ monitoring procedures. These
challenges are illustrated with respect to a real carbon fiber draping industrial process. We
abstract three diferent levels: a Task planner computing the process evolution taking into
account the robot and human capabilities; a Motion Planner, computing the collision-free
trajectories, that uses the Safe Zones for human safety; a Central Node monitoring the actions
of the operator in the environment.</p>
    </sec>
    <sec id="sec-6">
      <title>Acknowledgments</title>
      <p>This project has received funding from the European Union’s Horizon 2020 research and
innovation program under grant agreement No 101006732 (DrapeBot).</p>
    </sec>
  </body>
  <back>
    <ref-list>
      <ref id="ref1">
        <mixed-citation>
          [1]
          <string-name>
            <given-names>G.</given-names>
            <surname>Chryssolouris</surname>
          </string-name>
          ,
          <string-name>
            <given-names>N.</given-names>
            <surname>Papakostas</surname>
          </string-name>
          ,
          <string-name>
            <given-names>D.</given-names>
            <surname>Mavrikios</surname>
          </string-name>
          ,
          <article-title>A perspective on manufacturing strategy: Produce more with less</article-title>
          ,
          <source>CIRP Journal of Manufacturing Science and Technology</source>
          <volume>1</volume>
          (
          <year>2008</year>
          ).
        </mixed-citation>
      </ref>
      <ref id="ref2">
        <mixed-citation>
          [2]
          <string-name>
            <given-names>L.</given-names>
            <surname>Tagliapietra</surname>
          </string-name>
          ,
          <string-name>
            <given-names>E.</given-names>
            <surname>Tosello</surname>
          </string-name>
          , E. Menegatti,
          <article-title>Curami: human-robot collaboration for intelligent assembly tasks</article-title>
          ,
          <source>in: 2nd Italian Conf. on Robotics and Machine Intelligence</source>
          ,
          <string-name>
            <surname>I-RIM</surname>
          </string-name>
          , Rome,
          <year>2020</year>
          .
        </mixed-citation>
      </ref>
      <ref id="ref3">
        <mixed-citation>
          [3]
          <string-name>
            <given-names>J.</given-names>
            <surname>Cacace</surname>
          </string-name>
          ,
          <string-name>
            <given-names>R.</given-names>
            <surname>Caccavale</surname>
          </string-name>
          ,
          <string-name>
            <given-names>A.</given-names>
            <surname>Finzi</surname>
          </string-name>
          ,
          <string-name>
            <given-names>R.</given-names>
            <surname>Grieco</surname>
          </string-name>
          ,
          <article-title>Combining human guidance and structured task execution during physical human-robot collaboration</article-title>
          ,
          <source>Intelligent Manufacturing</source>
          <volume>34</volume>
          (
          <year>2022</year>
          ).
        </mixed-citation>
      </ref>
      <ref id="ref4">
        <mixed-citation>
          [4]
          <string-name>
            <given-names>H.</given-names>
            <surname>Guo</surname>
          </string-name>
          ,
          <string-name>
            <given-names>F.</given-names>
            <surname>Wu</surname>
          </string-name>
          ,
          <string-name>
            <given-names>Y.</given-names>
            <surname>Qin</surname>
          </string-name>
          ,
          <string-name>
            <given-names>R.</given-names>
            <surname>Li</surname>
          </string-name>
          ,
          <string-name>
            <given-names>K.</given-names>
            <surname>Li</surname>
          </string-name>
          ,
          <string-name>
            <given-names>K.</given-names>
            <surname>Li</surname>
          </string-name>
          ,
          <article-title>Recent trends in task and motion planning for robotics: A survey, ACM Computing Surveys (</article-title>
          <year>2023</year>
          ).
        </mixed-citation>
      </ref>
      <ref id="ref5">
        <mixed-citation>
          [5]
          <string-name>
            <given-names>C. R.</given-names>
            <surname>Garrett</surname>
          </string-name>
          ,
          <string-name>
            <given-names>T.</given-names>
            <surname>Lozano-Pérez</surname>
          </string-name>
          ,
          <string-name>
            <given-names>L. P.</given-names>
            <surname>Kaelbling</surname>
          </string-name>
          ,
          <string-name>
            <surname>Ffrob:</surname>
          </string-name>
          <article-title>An eficient heuristic for task and motion planning, in: Algorithmic Foundations of Robotics XI: Selected Contrib</article-title>
          .
          <source>of the 11th Intl. Workshop on the Algorithmic Foundations of Robotics</source>
          , Springer,
          <year>2015</year>
          .
        </mixed-citation>
      </ref>
      <ref id="ref6">
        <mixed-citation>
          [6]
          <string-name>
            <given-names>S.</given-names>
            <surname>Srivastava</surname>
          </string-name>
          ,
          <string-name>
            <given-names>E.</given-names>
            <surname>Fang</surname>
          </string-name>
          ,
          <string-name>
            <given-names>L.</given-names>
            <surname>Riano</surname>
          </string-name>
          ,
          <string-name>
            <given-names>R.</given-names>
            <surname>Chitnis</surname>
          </string-name>
          ,
          <string-name>
            <given-names>S.</given-names>
            <surname>Russell</surname>
          </string-name>
          , P. Abbeel,
          <article-title>Combined task and motion planning through an extensible planner-independent interface layer</article-title>
          ,
          <source>in: 2014 IEEE International Conference on Robotics and Automation (ICRA)</source>
          ,
          <year>2014</year>
          .
        </mixed-citation>
      </ref>
      <ref id="ref7">
        <mixed-citation>
          [7]
          <string-name>
            <given-names>N. T.</given-names>
            <surname>Dantam</surname>
          </string-name>
          ,
          <string-name>
            <given-names>Z. K.</given-names>
            <surname>Kingston</surname>
          </string-name>
          ,
          <string-name>
            <given-names>S.</given-names>
            <surname>Chaudhuri</surname>
          </string-name>
          ,
          <string-name>
            <given-names>L. E.</given-names>
            <surname>Kavraki</surname>
          </string-name>
          ,
          <article-title>Incremental task and motion planning: A constraint-based approach</article-title>
          ., in: Robotics:
          <article-title>Science and systems</article-title>
          , volume
          <volume>12</volume>
          ,
          <string-name>
            <surname>Ann</surname>
            <given-names>Arbor</given-names>
          </string-name>
          , USA,
          <year>2016</year>
          .
        </mixed-citation>
      </ref>
      <ref id="ref8">
        <mixed-citation>
          [8]
          <string-name>
            <given-names>A.</given-names>
            <surname>Nouman</surname>
          </string-name>
          ,
          <string-name>
            <given-names>V.</given-names>
            <surname>Patoglu</surname>
          </string-name>
          , E. Erdem,
          <article-title>Hybrid conditional planning for robotic applications, The Intl</article-title>
          .
          <source>J. of Robotics Research</source>
          (
          <year>2020</year>
          ).
        </mixed-citation>
      </ref>
      <ref id="ref9">
        <mixed-citation>
          [9]
          <string-name>
            <given-names>N.</given-names>
            <surname>Castaman</surname>
          </string-name>
          ,
          <string-name>
            <given-names>E.</given-names>
            <surname>Pagello</surname>
          </string-name>
          ,
          <string-name>
            <given-names>E.</given-names>
            <surname>Menegatti</surname>
          </string-name>
          ,
          <string-name>
            <given-names>A.</given-names>
            <surname>Pretto</surname>
          </string-name>
          ,
          <article-title>Receding horizon task and motion planning in changing environments</article-title>
          ,
          <source>Robotics and Autonomous Systems</source>
          <volume>145</volume>
          (
          <year>2021</year>
          ).
        </mixed-citation>
      </ref>
      <ref id="ref10">
        <mixed-citation>
          [10]
          <string-name>
            <given-names>N.</given-names>
            <surname>Castaman</surname>
          </string-name>
          ,
          <string-name>
            <given-names>E.</given-names>
            <surname>Tosello</surname>
          </string-name>
          , E. Pagello,
          <article-title>Conditional task and motion planning through an efort-based approach</article-title>
          , in: 2018 IEEE International Conference on Simulation, Modeling, and
          <article-title>Programming for Autonomous Robots (SIMPAR)</article-title>
          , IEEE,
          <year>2018</year>
          , pp.
          <fpage>49</fpage>
          -
          <lpage>54</lpage>
          .
        </mixed-citation>
      </ref>
      <ref id="ref11">
        <mixed-citation>
          [11]
          <string-name>
            <given-names>F.</given-names>
            <surname>Lagrifoul</surname>
          </string-name>
          ,
          <string-name>
            <given-names>N.</given-names>
            <surname>Dantam</surname>
          </string-name>
          ,
          <string-name>
            <given-names>C.</given-names>
            <surname>Garrett</surname>
          </string-name>
          ,
          <string-name>
            <given-names>A.</given-names>
            <surname>Akbari</surname>
          </string-name>
          ,
          <string-name>
            <given-names>S.</given-names>
            <surname>Srivastava</surname>
          </string-name>
          ,
          <string-name>
            <given-names>L. E.</given-names>
            <surname>Kavraki</surname>
          </string-name>
          ,
          <article-title>Platformindependent benchmarks for task and motion planning</article-title>
          ,
          <source>IEEE Robotics and Automation Letters</source>
          <volume>3</volume>
          ,
          <issue>4</issue>
          (
          <year>2018</year>
          ).
        </mixed-citation>
      </ref>
      <ref id="ref12">
        <mixed-citation>
          [12]
          <string-name>
            <given-names>M.</given-names>
            <surname>Terreran</surname>
          </string-name>
          ,
          <string-name>
            <given-names>S.</given-names>
            <surname>Ghidoni</surname>
          </string-name>
          ,
          <string-name>
            <given-names>E.</given-names>
            <surname>Menegatti</surname>
          </string-name>
          ,
          <string-name>
            <given-names>E.</given-names>
            <surname>Villagrossi</surname>
          </string-name>
          ,
          <string-name>
            <given-names>N.</given-names>
            <surname>Castaman</surname>
          </string-name>
          ,
          <string-name>
            <given-names>A.</given-names>
            <surname>Gottardi</surname>
          </string-name>
          ,
          <string-name>
            <given-names>C.</given-names>
            <surname>Eitzinger</surname>
          </string-name>
          , et al.,
          <article-title>A smart workcell for cooperative assembly of carbon fiber parts guided by human actions</article-title>
          ,
          <source>in: 4th Italian Conf. on Robotics and Machine Intelligence</source>
          ,
          <string-name>
            <surname>I-RIM</surname>
          </string-name>
          , Rome,
          <year>2022</year>
          .
        </mixed-citation>
      </ref>
      <ref id="ref13">
        <mixed-citation>
          [13]
          <string-name>
            <given-names>A.</given-names>
            <surname>Gottardi</surname>
          </string-name>
          ,
          <string-name>
            <given-names>M.</given-names>
            <surname>Terreran</surname>
          </string-name>
          ,
          <string-name>
            <given-names>C.</given-names>
            <surname>Frommel</surname>
          </string-name>
          ,
          <string-name>
            <given-names>M.</given-names>
            <surname>Schoenheits</surname>
          </string-name>
          ,
          <string-name>
            <given-names>N.</given-names>
            <surname>Castaman</surname>
          </string-name>
          ,
          <string-name>
            <given-names>S.</given-names>
            <surname>Ghidoni</surname>
          </string-name>
          , E. Menegatti,
          <article-title>Dynamic human-aware task planner for human-robot collaboration in industrial scenario</article-title>
          ,
          <source>in: 2023 European Conference on Mobile Robots (ECMR)</source>
          , IEEE,
          <year>2023</year>
          .
        </mixed-citation>
      </ref>
      <ref id="ref14">
        <mixed-citation>
          [14]
          <string-name>
            <given-names>L.</given-names>
            <surname>Barcellona</surname>
          </string-name>
          ,
          <string-name>
            <given-names>M.</given-names>
            <surname>Terreran</surname>
          </string-name>
          ,
          <string-name>
            <given-names>D.</given-names>
            <surname>Evangelista</surname>
          </string-name>
          ,
          <string-name>
            <given-names>S.</given-names>
            <surname>Ghidoni</surname>
          </string-name>
          ,
          <article-title>Clustering-based refinement for 3d human body parts segmentation</article-title>
          ,
          <source>in: Intl. Conf. on Intelligent Autonomous Systems</source>
          , Springer,
          <year>2022</year>
          .
        </mixed-citation>
      </ref>
    </ref-list>
  </back>
</article>