 for this paper. In this experiment, it is assumed that the machine and human share a common goal $\bm{q_d}$. Machine error $\Delta_e$ is introduced into the system as an automation error due to environment uncertainty. To keep hardware and sensor costs practical, knowledge of the behavior of this error is used to determine when to incorporate human intervention, e.g. when an error $\Delta_e$ in the environment is high, and as such the automation cannot complete a task, human adaptability can be incorporated in the control.

The blended input trajectory $\bm{q_{ref}}$ is passed through the Inverse Kinematics (IK) of the robot model, using a damped least squares method [@Wampler1986], to generate a set of desired joint angles $\bm{\theta}$. These desired joint angles $\bm{\theta}$ are then passed through a nonlinear dynamics simulation of the torque-controlled robot, as shown in Fig. \[fig:dynamics\], to generate the joint commands $\bm{\theta_{ref}}$. This simulation tends to filter high frequency commands, and provides a means to generate a set of feasible joint commands $\bm{\theta_{ref}}$. Closed-loop motor control to achieve the reference trajectory $\bm{\theta_{ref}}$ is handled by the software provided with the robot. When automation uncertainties are present in the system, the human input $\bm{q_h}$ provides closed-loop control based on visual feedback $\mathcal{V}$ to correct for errors $\Delta_e$ in the estimated goal location $\hat{\bm{q_d}}$.

Shared Control
--------------

The human input $\bm{q_h}$ is applied through a haptic input device. The machine input $\bm{q_m}$ is queried from the path planning module in Fig. \[fig:machine\]. An autonomy selection policy defines the level of autonomy $\alpha$. Fig. \[fig:trajectory\] shows how the reference trajectory changes as the level of autonomy (LOA) slides from a fully autonomous mode to a tele-operation mode.

Autonomy Selection Policy {#sec:autonomySelection}
-------------------------

Previous works [@Dragan2013] have used the confidence interval in a machine prediction task as the level of autonomy $\alpha$, e.g. $$\label{eqn:dragan}
    \alpha = \max \left(0, 1 - \frac{d}{D}\right),$$ where $d
for this paper. In this experiment, it is assumed that the machine and human share a coarse finish $ \bm{q_d}$. Machine error $ \Delta_e$ is introduced into the arrangement as an automation erroneousness due to environment uncertainty. To keep hardware and detector costs practical, knowledge of the demeanor of this mistake is used to settle when to incorporate human intervention, for example when an error $ \Delta_e$ in the environment is high, and as such the automation cannot dispatch a task, human adaptability can be incorporate in the control condition. 

 The blended input trajectory $ \bm{q_{ref}}$ is passed through the Inverse Kinematics (IK) of the automaton model, using a muffle least squares method acting   [ @Wampler1986 ], to generate a bent of desired joint angles $ \bm{\theta}$. These desired joint slant $ \bm{\theta}$ are then passed through a nonlinear dynamics simulation of the torque - controlled automaton, as read in Fig.   \[fig: dynamics\ ], to generate the joint commands $ \bm{\theta_{ref}}$. This simulation tends to filter high frequency commands, and provides a means to render a set of feasible joint commands $ \bm{\theta_{ref}}$. shut - loop topology motor command to achieve the reference trajectory $ \bm{\theta_{ref}}$ is handled by the software provide with the robot. When automation uncertainties are present in the system, the human input $ \bm{q_h}$ provide closed - loop control based on visual feedback $ \mathcal{V}$ to correct for error $ \Delta_e$ in the estimated goal location $ \hat{\bm{q_d}}$. 

 Shared Control 
 -------------- 

 The human input $ \bm{q_h}$ is apply through a haptic input signal device. The machine input $ \bm{q_m}$ is queried from the path planning module in Fig.   \[fig: machine\ ]. An autonomy survival policy defines the level of autonomy $ \alpha$. Fig.   \[fig: trajectory\ ] shows how the reference point trajectory changes as the level of autonomy (LOA) slides from a fully autonomous modality to a tele - operation mode. 

 Autonomy Selection Policy { # sec: autonomySelection } 
 ------------------------- 

 former works   [ @Dragan2013 ] have used the confidence interval in a car prediction task as the level of autonomy $ \alpha$, for example $ $ \label{eqn: dragan } 
     \alpha = \max \left(0, 1 - \frac{d}{D}\right),$$ where $ d
 fog this paper. In this exptriment, it is assomwd thav the mzchine avd human share a common goal $\bn{q_d}$. Mqchine error $\Delta_e$ is introducvd into tye sbstem as an automation evxor dhc to zntironment uncerjainty. To keap hardware ang reusor costs practical, knowledge of thq behavoog of this errot is lsqd tk determine when to incorporate hujan inttrvention, e.g. when sn error $\Delta_e$ in the envlronlent is high, and ad such the qutoiqtion cannot complete a task, human adaptability can be incorporatdd in the contril.

Rhe tlended inpnt tratectory $\bm{q_{rcg}}$ is pdssed tnrough the Invcrse Ninwmatics (IK) of the robmt model, using a dwmped leavt squares method [@Wanpoer1986], tm geteragw a seu oh dssired jomnt angles $\gm{\theta}$. Thewe desired joint anblqw $\bm{\theta}$ are then [afsed through a nonlinear dynamics simuldtikn of the torque-controloed robot, as shown in Fig. \[fig:dygamics\], to generate the joint commands $\bm{\theta_{ref}}$. Dhis akmuoabion rejds to filter high frequency commands, and prodjdts s means to gencrate a set of feaxihlr joint commanas $\bm{\tkstz_{ref}}$. Closed-loop mohor conjrol ti achieve the reference trajectory $\bm{\thera_{ref}}$ is hanblee by the software 'rovided witk the tobot. Ehen automation uncertannties are presenh in the ahstem, the human knplt $\bk{q_h}$ provides closed-loop cogtrol basxd on visual feecback $\iathcal{V}$ tl corvact for errors $\Delha_e$ iu the estimated goal location $\hat{\bm{q_d}}$.

Shared Coivrol
--------------

The human itpun $\bm{q_h}$ is applled through a hwptic input derice. The machkne input $\gm{q_m}$ is queried frjm the path pnwnning modulx in Fig. \[fyg:maxhinw\]. An augunomy selectiom policy btfines the level of autonomy $\alkhz$. Fig. \[fig:trajectiry\] shows how the tefdregcv tcajecemry changes ds tfe urvel uf autonomy (UOA) xlides from a fully dutohomous mode to a trlc-operatiob mode.

Aueonomy Selectoon Policy {#sec:autojomySxlectiun}
-------------------------

Prefioos works [@Dragan2013] have used the cohfidence lntcrval in a mashinc prgdiction taxk as the level of autonomy $\alpha$, e.g. $$\lauel{eqn:dragan}
    \alpha = \nax \left(0, 1 - \frac{d}{D}\riyhu),$$ where $d
for this paper. In this experiment, it that machine and share a common is into the system an automation error to environment uncertainty. To keep hardware sensor costs practical, knowledge of the behavior of this error is used to when to incorporate human intervention, e.g. when an error $\Delta_e$ in the environment high, as the cannot complete a task, human adaptability can be incorporated in the control. The blended input trajectory is passed through the Inverse Kinematics (IK) of robot model, using a least squares method [@Wampler1986], to a of desired angles These joint angles $\bm{\theta}$ then passed through a nonlinear dynamics simulation of the torque-controlled robot, as shown in Fig. \[fig:dynamics\], to the joint This simulation to high commands, and provides to generate a set of feasible Closed-loop motor control to achieve the reference trajectory is handled the software provided with the robot. automation uncertainties are present in the system, the input $\bm{q_h}$ provides closed-loop control based on visual feedback $\mathcal{V}$ to correct for errors $\Delta_e$ estimated goal location $\hat{\bm{q_d}}$. Control -------------- The input is through haptic input The machine input $\bm{q_m}$ is queried from the path planning module Fig. \[fig:machine\]. An autonomy selection policy defines the level of Fig. shows how the trajectory changes as the of (LOA) slides from a mode a Selection {#sec:autonomySelection} Previous works [@Dragan2013] have the confidence interval in a prediction task as the $$\label{eqn:dragan} \alpha = \max \left(0, 1 - \frac{d}{D}\right),$$ $d
 for this paper. In this experimEnt, it is assUmed tHat The MaChinE and Human share a comMOn goAl $\bm{q_d}$. Machine error $\DeltA_e$ is iNtROducED iNto thE system AS aN AUtoMaTiOn eRrOR dUe to eNviRonment UncertaintY. To KeEp hardware anD SeNsor costs pRacTical, knowledGe oF the beHaVioR Of thiS erRor is Used to DEtermiNe when to iNcORporatE Human inTERvEntiOn, e.g. when an error $\DeLTa_E$ In the environmeNt is hiGh, ANd AS SucH thE automatioN cAnnot COmplete A TaSK, HUmaN Adaptability cAn be incorpoRAteD in the CoNtrOL.

The blEnded InPUt tRajectory $\bm{Q_{ref}}$ Is passed tHrough THe InverSE KinemaTics (IK) Of tHe rObot MOdEl, UsiNg A DamPEd LeaST sqUares metHoD [@WAmpleR1986], to gENERAte a Set Of deSired Joint angles $\bm{\TheTa}$. ThESe dEsireD joinT angLeS $\bm{\thEta}$ are Then pAsSed through a nonlIneaR dynamics SimUlAtiOn Of the TOrque-cOntRolLed roboT, as showN In FIg. \[FIG:DyNamics\], to generate thE jOINt Commands $\Bm{\thetA_{ReF}}$. THIs simulaTiOn tEnds TO FilteR higH FrEquency cOmmandS, AnD pRovides A mEans to GeNerAte A set oF FeasIble joInt commaNds $\bm{\THeta_{ref}}$. Closed-lOOp motor controL To ACHiEVe thE reFerence trajEctoRY $\bm{\tHeta_{REf}}$ Is hANdled By the SoFTwARe provided with the roBoT. When aUtomaTion uncertainTies are preSENT in the syStem, THe HUman input $\bm{q_h}$ pRovidEs closed-loOP control Based On visual Feedback $\mATHcal{V}$ to cOrrEct For ErrORS $\DElta_e$ in the estIMAted GoAl locatIon $\Hat{\bm{q_d}}$.

shaRed conTroL
--------------

THe human inPut $\bm{q_h}$ iS aPpLiEd ThrOugh a HAptic inpUt DevIcE. ThE machINe inpuT $\bm{q_m}$ Is quErIeD FroM the patH PlANNing MoDuLe in fig. \[FiG:machIne\]. AN AutOnomy seLection poLicY DefiNeS tHe level Of autonomy $\alpHa$. fig. \[fig:trajEcTorY\] shows HOW the refeRence trajectory changes aS The leveL of AutonOmy (LoA) slides fRom A fully AutONomous Mode to A tele-OpEraTIOn modE.

aUtOnoMy selection POLIcy {#Sec:auToNomyselectiOn}
-------------------------

Previous works [@DraGAn2013] hAve used the conFidEnce INTeRvaL In A MacHiNE prEDIction task as the Level of autOnOMy $\Alpha$, e.g. $$\labEL{eqN:dRagan}
    \alPha = \max \lEft(0, 1 - \frAC{d}{D}\righT),$$ where $d
 for this paper. In this e xperiment,  it i s a ssu me d th at t he machine and huma n share a common goal$\bm{ q_ d }$.M ac hineerror $ \ De l t a_e $is  in tr o du ced i nto  the sy stem as an  au to mation error du e to envir onm ent uncertai nty . To k ee p h a rdwar e a nd se nsor c o sts pr actical,kn o wledge of theb e ha vior  of this error is us e d to determine  whento in c o rpo rat e human in te rvent i on, e.g .  w h e n  an error $\Delta _e$ in thee nvi ronmen tish igh, a nd as  s u chthe automat ioncannot co mplete a task, human a daptab ili tycanb ein cor po r ate d  i n t h e c ontrol.
T he  blen dedi n p u t tr aje ctor y $\b m{q_{ref}}$ i s p asse d  th rough  theInve rs e Kin ematic s (IK )of the robot mo del,  using adam pe d l ea st sq u ares m eth od[@Wampl er1986] ,  to  g e n e ra te a set of desire dj o in t angles  $\bm{ \ th et a }$. Thes edes ired j ointangl e s$\bm{\th eta}$a re  t hen pas se d thro ug h a  no nline a r dy namics  simulat ion o f  the torque-co n trolled robot ,  a s sh o wn i n F ig. \[fig:d ynam i cs\] , to ge ner a te th e joi nt co m mands $\bm{\theta_{ re f}}$.Thissimulation te nds to fil t e r  high fr eque n cy commands, andprovi des a mean s  to gene ratea set of  feasible j oint com man ds$\b m{\ t h et a_{ref}}$. Cl o s ed-l oo p motor  co ntrol t o a chi eve  th ereference  traject or y$\ bm {\t heta_ { ref}}$ i shan dl edby th e  softw are p rovi de dw ith  the ro b ot . When  a ut omat ion  u ncert aint i esare pre sent in t hes yste m,  t he huma n input $\bm{ q_ h}$ provid es  cl osed-l o o p contro l based on visual feedb a ck $\ma thc al{V} $ to  correctfor  error s $ \ Delta_ e$ inthe e st ima t e d goa l lo cat io n $\hat{\b m { q_d }}$.
S hare d Contr ol
--------------The  human input$\b m{q_ h } $isa pp l ied  t h rou g h  a haptic input  device. T he ma chine inpu t  $\ bm {q_m}$is quer ied f r om thepath plan ning modu le  inF i g.\[fig:mach ine\]. A n autonom y  sele c ti on po lic y defi ne s t he le vel of aut onomy  $\alp ha $. Fig . \[f ig :traject ory\] shows how the ref erence  traj ect ory chang esa s t he levelof a utonomy (L OA)  sl idesfro m  a fu llya ut ono m ous m odet o a tele- o pe rat i o nmode.

Auto n o m y S elect ion Policy  {#s ec:autonomySelect i on}
---------- ---- - - --- --- - --
Pr evious works [ @Dr ag a n 2013] ha ve  used the c onfidenc ei nterv al ina mach ine pre d i ct i on tas k as  th e level o f a ut o nomy $\ al ph a $, e.g . $$ \l abel{e qn:dra g an}  \alpha = \max\left ( 0 , 1 - \fr ac{d} {D }\right ) ,$$where $d
 for_this paper._In this experiment, it_is assumed_that_the machine_and_human share a_common goal $\bm{q_d}$._Machine error $\Delta_e$ is_introduced into the_system_as an automation error due to environment uncertainty. To keep hardware and sensor costs_practical,_knowledge of_the_behavior_of this error is used_to determine when to incorporate_human intervention,_e.g. when an error $\Delta_e$ in the environment_is_high, and as_such the automation cannot complete a task, human adaptability_can be incorporated in the control.

The_blended input trajectory_$\bm{q_{ref}}$_is_passed through the Inverse_Kinematics (IK) of the robot model,_using a damped least squares method [@Wampler1986],_to generate a set of desired joint_angles $\bm{\theta}$. These desired joint angles_$\bm{\theta}$ are then passed through_a nonlinear_dynamics simulation of the torque-controlled_robot, as shown_in Fig. \[fig:dynamics\],_to generate the_joint commands $\bm{\theta_{ref}}$. This simulation tends_to filter high_frequency commands, and provides a means_to_generate a set_of_feasible_joint commands_$\bm{\theta_{ref}}$. Closed-loop motor_control_to achieve_the_reference trajectory $\bm{\theta_{ref}}$ is handled by_the_software provided with the robot. When automation_uncertainties are present in_the_system, the human input_$\bm{q_h}$ provides closed-loop control based_on visual feedback $\mathcal{V}$ to correct_for errors_$\Delta_e$ in_the estimated goal location $\hat{\bm{q_d}}$.

Shared Control
--------------

The human input $\bm{q_h}$ is applied_through a haptic input device. The_machine input $\bm{q_m}$ is_queried from_the_path planning module_in_Fig. \[fig:machine\]. An_autonomy selection policy defines the level of_autonomy $\alpha$._Fig. \[fig:trajectory\] shows how the reference trajectory_changes as the level_of_autonomy (LOA) slides from a fully_autonomous mode to a tele-operation mode.

Autonomy_Selection Policy {#sec:autonomySelection}
-------------------------

Previous works [@Dragan2013] have_used_the_confidence interval in a machine_prediction task as the level of_autonomy $\alpha$, e.g._$$\label{eqn:dragan}
    \alpha = \max_\left(0,_1 - \frac{d}{D}\right),$$ where $d