Crossing-Point Estimation in Human–Robot Navigation—Statistical Linearization versus Sigma-Point Transformation

Interactions between mobile robots and human operators in common areas require a high level of safety, especially in terms of trajectory planning, obstacle avoidance and mutual cooperation. In this connection, the crossings of planned trajectories and their uncertainty based on model fluctuations, system noise and sensor noise play an outstanding role. This paper discusses the calculation of the expected areas of interactions during human–robot navigation with respect to fuzzy and noisy information. The expected crossing points of the possible trajectories are nonlinearly associated with the positions and orientations of the robots and humans. The nonlinear transformation of a noisy system input, such as the directions of the motion of humans and robots, to a system output, the expected area of intersection of their trajectories, is performed by two methods: statistical linearization and the sigma-point transformation. For both approaches, fuzzy approximations are presented and the inverse problem is discussed where the input distribution parameters are computed from the given output distribution parameters.


Introduction
The planning and performing of mobile robot tasks in the presence of human operators while sharing the same workspace requires a high level of stability and safety.Research activities regarding navigation, obstacle avoidance, adaptation and collaboration between robots and human agents have been widely reported [1,2].Multiple target tracking for robots using higher control levels in a control hierarchy are discussed in [3,4].A humanfriendly interaction between robots and humans can be obtained by human-like sensor systems [5].A prominent role in robot navigation is the trajectory-crossing problem of robots and humans [6,7] and corresponding fuzzy solutions [8].Motivations for a fuzzy solution of the intersection problem are manifold.One point is an uncertain measurement of the position and orientation of the human agent, because of which the use of a fuzzy signal and an adequate fuzzy processing seems natural [9,10].Another aspect is the need for decreasing the computing effort in the case of complex calculations during a very small time interval.System uncertainties and observation noise lead to uncertainties of the intersection estimations.
The objective of this work is the formulation of the crossing/intersection problem by taking into account the uncertainties in human-robot systems, including sensors and motor characteristics.An important aspect is to define permissible uncertainties in a human-robot system for a given uncertainty at a possible intersection of their trajectories.Taking into account the nonlinearities, this is performed by the differential approach and a following analysis of the regarding Gaussian distributions.This approach is compared with the sigma-point transformation, which represents a simplification of the computation and a qualitative extension of the analysis regarding the statistics of the random variables.For broader areas of possible intersections, both methods are extended to fuzzy regions together with different numbers and shapes of fuzzy sets.The most important contributions are as follows: • An investigation of uncertainties of possible intersection areas originating from sensor noise or system uncertainties.• A direct and inverse transformation of the error variables at the intersection areas for two input variables (orientation angles) and two output variables (intersection coordinates).

•
An extension of the method from two to six input variables (two orientation angles and four position coordinates).

•
An exploration of the formulations of fuzzy versions.

•
A formulation of the problem by the sigma-point transformation and corresponding comparison of the two methods.
This paper deals with the one-robot one-human trajectory-crossing problem, where small uncertainties in the position and orientation may lead to high uncertainties at the intersection points.The position and orientation of the human and robot are nonlinearly coupled but can be linearized.In the following, the linear part of the nonlinear system is considered in the analysis reported for small variations in the input [11].Then, the "direct task" is described, meaning that the parameters of the input distribution are transformed to the output distribution parameters.The "inverse task" is also solved, meaning that for the defined output distribution parameters the input parameters are calculated.In this paper, two methods are outlined: 1.
The statistical linearization, which linearizes the nonlinearity around the operating area at the intersection.The means and standard deviations on the input parameters positions (orientations) are transformed through the linearized nonlinear system to obtain the means and standard deviations of the output parameters (the position of intersection).

2.
The sigma-point transformation, which calculates the so-called sigma points of the input distribution, including the mean and covariance of the input.The sigma points are directly propagated through the nonlinear system [12][13][14] to obtain the means and covariance of the output and, with this, the standard deviations of the output (the position of intersection).The advantage of the sigma-point transformation is that it captures the first-and second-order statistics of a random variable, whereas the statistical linearization approximates a random variable only by its first order.However, the computational complexity of the extended Kalman filter (EKF, differential approach) and unscented Kalman filter (UKF, sigma-point approach) is of the same order [13].
This paper is organized as follows.Section 2 describes the related work already conducted on unscented Kalman filters in mobile robot applications.In Section 3, the general intersection problem and its analytical approach is described.Section 4 deals with the transformation/conversion of Gaussian distributions for a two-input-two-output system and for a six-input-two-output system plus the corresponding inverse and fuzzy solutions.In Section 5, the sigma-point approach plus inverse and fuzzy solutions are addressed.Section 6 presents simulations of the statistical linearization and the sigma-point transformation to show the quality of the input-output conversion of the distributions and the impact of different resolutions of fuzzy approximations on the accuracy of the random variable intersection.Finally, Section 7 concludes this paper with a discussion of the two different approaches and a comparison of the methods.

Related Work
The crossing problem for mobile robots has been especially dealt with by [6,7].Both publications deal with the so-called rendezvous problem whereby the key point is the trajectory planning under time constraints, taking into account the dynamics of the con-tributing robots.Uncertainties of possible intersection areas that come from sensor noise or system uncertainties are not discussed deeply.A fuzzy-adaptive extended Kalman filter (FAEKF) for the real-time attitude estimation of a mobile robot is proposed in [15] where fuzzy IF-THEN rules-based adaption laws modify the noise covariance matrices of the filter.However, the use of unscented Kalman filters or sigma-point transformation has not been discussed.For the estimation of landmarks, a simultaneous localization and mapping (SLAM) method is presented by [16] where an iterated sigma-point FastSLAM (ISP-FastSLAM) algorithm is proposed to minimize statistical linearization errors through the Gaussian-Newton iteration.A further application is presented by [17] where a walking robot uses sigma-point transformation for state estimation to guarantee stability in the system's hybrid dynamics, which contains continuous and switching parts during movement.In [18], a vision-based SLAM system uses both extended Kalman filters (EKFs) and sigmapoint Kalman filter (SPKF) algorithms and showed its superiority over the EKF.The pose estimation of mobile robots is discussed in [19] whereby several filter techniques like the Kalman filter (EKF), the unscented Kalman filter (UKF) and several variants of the particle filter (PF) are compared.It turns out that the UKF (also the sigma-point approach) exhibits almost the same computational cost.In [20], the inter-robot and robot-target correlations are discussed, and unscented transformation-based collaborative self-localization and a target tracking algorithm between robots are proposed.A tutorial on different approaches to exploit the structure of a system's state and measurement models to reduce the computational demand of the algorithms is presented by [21].In this publication, the computational complexity of different state estimation algorithms is presented, showing the superiority of the sigma-point transformation algorithms.
In all these publications, the problem of obstacle avoidance and/or the crossing problem in the presence of human actors are not taken into account, because of which the present paper is a further contribution to the robot-human interaction problem.

Computation of Intersections
The problem can be stated as follows: A robot and human agent move in a common area according to their tasks or intentions.To avoid collisions, possible intersections of the paths of the agents should be predicted for both the trajectory planning and on-line interactions.To accomplish this, the positions, orientations and intended movements of the robot and human should be estimated as accurately as needed.
In this connection, uncertainties and noise on the random variables' position/orientation x R , x H , ϕ R and ϕ H of the robot and human have a great impact on the calculation of the expected intersection position x c .The random variable x c is calculated as the crossing point of the extension of the orientation or velocity vectors of the robot and human, which may change during motion depending on the task and current interaction.The task is to calculate the intersection and its uncertainty in the presence of the known uncertainties of the acting agent robot and human.
System noise w R and w H for the robot and human can be obtained from experiments.The noise w c of the "virtual" intersection is composed of the nonlinear transformed noise w R and w H and some additional noise v c that may come from uncertainties of the nonlinear computation of the intersection position x c (see Figure 1).In the following, the geometrical relations are described as well as the fuzzy approximations and nonlinear transformations of the random variables x R , x H , ϕ R and ϕ H .

Geometrical Relations
Let the y-axis of the mobile coordinate frame of the robot and human be aligned with their directions of motion.Furthermore, let the orientation angles ϕ R and ϕ H of the robot and human be measured from the x-axis of the base frame counterclockwise.Let the intersection (x c , y c ) of the two linear trajectories x R (t) and x H (t) in a plane be described by the following relations (see Figure 2): x where x H = (x H , y H ) and x R = (x R , y R ) are the positions of the human and robot and ϕ H and ϕ R are their orientation angles, and δ H and δ R are the positive angles measured from the y coordinates counterclockwise.The angle at the intersection is β = π − δ R − δ H .The variables x H , x R , ϕ R , ϕ H δ H and ϕ H δ R ; distance d RH ; and angle γ are assumed to be measurable.Angle γ is a bearing angle for the robot-to-human direction measured in base coordinates.If ϕ H is not directly measurable, then it can be computed by The coordinates x c and y c of the intersection are computed straightforwardly by [8] x Rewriting (3) leads to After rearranging (4), we observe that where This notation is of advantage for further computations, such as the fuzzification of the intersection problem and the transformation of the error distributions.

Computation of Intersections-Fuzzy Approach
The fuzzy solution presented in the following is a combination of classical analytical (crisp) methods and rule-based methods in the sense of a Takagi-Sugeno fuzzy rule base.An appropriate choice of the number of fuzzy sets and corresponding fuzzy rules depends strongly on the specific application.In the present case, fuzzy sets are used as the approximation of nonlinear functions.In the following, we introduce a fuzzy rule-based approximation of ( 5) with n × n fuzzy rules R i,j R i,j : n-the number of fuzzy terms, Φ R i and Φ H j for ϕ R and ϕ H , with the result Let the universes of discourse for ϕ R and ϕ H be ϕ R , ϕ H ∈ [0, 360].Furthermore, let these universes of discourse be divided into n partitions (for example, 6) of 60, which leads to 6 × 6 fuzzy rules.The corresponding membership functions are shown in Figure 3.It turns out that this resolution leads to a poor fuzzy approximation.The approximation quality can be improved by increasing the number of fuzzy sets, which however results in a quadratic increase in the number of fuzzy rules.To avoid an "explosion" of the number of fuzzy rules being computed in one time step, a set of sub-areas covering a small number of rules for each sub-area is defined.Based on the measurements of ϕ R and ϕ H , the appropriate sub-area is selected together with a corresponding set of rules (see Figure 4, sub-area A R , A H ). With this, the number of rules to be activated at one time step of calculation is low, although the total number of rules can be high.At the borderlines between the sub-areas, abrupt changes may occur, which can be avoided by overlapping the sub-areas.

Differential Approach
The positions and orientations of robots and humans are usually corrupted with noise originated from system uncertainties, sensor errors and motor characteristics.These uncertainties become apparent in uncertainties in the crossing/intersection areas of the trajectories of the robot and human.The analysis of uncertainty and noise at x c generated by the noise at ϕ R , ϕ H and x RH = (x R , y R , x H , y H ) T requires a linearization of (4) around the operating points and with this a differential strategy.Let, for simplification, only the orientation angles ϕ R and ϕ H be corrupted with noise.In Section 4.3, the positions x RH = (x R , y R , x H , y H ) T are taken into account, too.
Differentiating (4) with x RH = const.yields where The following sections deal with the accuracy of the computed intersection in the case of noisy orientation information (see Figure 5).

Transformation of Gaussian Distributions 4.1. General Assumptions
Consider a nonlinear system where the random variables x = (x 1 , x 2 ) T denote the input, z = (z 1 , z 2 ) T denotes the output and F denotes a nonlinear transformation.The distribution of the uncorrelated Gaussian distributed components x 1 and x 2 is described by )) (10) where e x 1 = x 1 − x1 , with x1 -the mean (x 1 ) and σ x 1 -the standard deviation x 1 , and e x 2 = x 2 − x2 , with x2 -the mean (x 2 ) and σ x 2 -the standard deviation x 2 .
The goal is as follows: Given the nonlinear transformation (9) and the distribution (10), compute the output signals z 1 and z 2 and their distributions together with their standard deviations and the correlation coefficient.Linear systems transform Gaussian distributions linearly such that the output signals are also Gaussian-distributed.This does not apply for nonlinear systems, but if the input standard deviation is small enough, then a local linear transfer function can be built for which the outputs are Gaussian-distributed. Suppose the input standard deviations are small with respect to the nonlinear function, then the output distribution can be written as follows: )) ρ z 12 -the correlation coefficient.

Statistical Linearization, Two Inputs-Two Outputs
Let the nonlinear transformation F be described by two smooth transfer functions (see block scheme Figure 6) where (x 1 , The linearization of ( 12) yields with e z = (e z 1 , e z 2 ) T and e x = (e x 1 , e x 2 ) T ( 14)

Output Distribution
To obtain the density f z 1 ,z 2 (11) of the output signal, we invert (15) and substitute the entries of e x into (10).J is invertible if it is positive definite with | J| > 0. Otherwise, there exist singularities due to different constellations of the position vector x RH and/or the orientations ϕ R and ϕ H .To find all the singularities requires a further analysis, which is not the content of this paper.However, a simple heuristic leads us to some obvious situations: then the human and robot would move in parallel either in the same or the opposite direction.On the other hand, one may also obtain diverging trajectories with no crossing.e x = J • e z (16) with J = J−1 and (17) where j xz = (J 11 , J 12 ) and j yz = (J 21 , J 22 ).The entries J ij are the result of the inversion of J.
From this substitution, we obtain where The exponent of ( 18) is rewritten into and furthermore ) + e 2 z 2 ( Let then a comparison of x po in (21) and the exponent in (11) yields The standard deviations σ z 1 and σ z 2 and the correlation coefficient ρ z 12 yield The result is as follows: If the parameter of the input distribution and the transfer function F(x, y) are known, then the output distribution parameters can be computed straightforwardly.

Fuzzy Solution
To save computing costs in real time, we create a TS fuzzy model that is represented by the rules R ij .

Inverse Solution
The previous paragraph discussed the direct transformation task: Let the distribution parameters of the input variable be defined and find the corresponding output parameters.However, it might also be useful to solve the inverse task: Given the output parameters (standard deviation and correlation coefficient), find the corresponding input parameters.This solution of the inverse task is similar to those discussed in Section 4.2.The starting points are equations ( 10) and (11), which describe the distributions of the inputs and outputs, respectively.Then, we substitute ( 13) into (10) and rename the resulting exponent x po z into x po x and discuss the exponent with Now, comparing (27) with the exponent of (10) of the input density, we find that the mixed term in (27) must be zero, from which we obtain the correlation coefficient ρ z 12 and with this the standard deviations of the inputs The detailed development can be found in [22].

Six Inputs-Two Outputs
Consider again the nonlinear system In the previous subsections, we assumed the positions x R and x H not to be corrupted with noise.However, taking into account the positions to be random variables, the number of inputs is 6 so that the input vector yields x = (x 1 , x 2 , x 3 , x 4 , x 5 , x 6 ) T or x = (ϕ R , ϕ H , x R , y R , x H , y H ) with the output vector x c = (x c , y c ) T .
Furthermore, let the uncorrelated Gaussian-distributed inputs x 1 . . .x 6 be described by the 6-dim density where e x = (e x1 , e x2 , . . ., e x6 ) T ; e x = x − x, x-the mean(x) and S x -the covariance matrix.According to (11), the output density is described by )) ρ-the correlation coefficient, e x c = (e x c , e y c ) T .After some calculations [23], we find for ρ, 1 This is the counterpart to the 2-dim input case (24).

Inverse Solution
An inverse solution cannot be uniquely computed due to the undetermined character of the 6-input-2-output system.Therefore, from the required variances at the intersection position (output), the corresponding variances for the positions and orientations of the robot-human or robot-robot (input) cannot be concluded.

Fuzzy Approach
The steps to the fuzzy approach are very similar to those of the 2-input case: -Define the operation points x i = (x 1 , x 2 , x 3 , x 4 , x 5 , x 6 ) T i ; -Compute A i , B i and C i at x i = (x 1 , x 2 , x 3 , x 4 , x 5 , x 6 ) T i from (33); -Formulate the fuzzy rules R i according to ( 25) and ( 26), i = 1 . . .n.
The number n of rules is computed as follows: With l = 6-the number of fuzzy terms and k = 6-the number of inputs, we obtain n = l k = 6 6 -the number of rules.
This number of rules is unacceptably high.To limit n to an adequate number, one has to limit the number of inputs and/or fuzzy terms to look for the most influential variables either in a heuristic or systematic way [24].This however is not the issue to be discussed in this paper.

Sigma-Point Transformation
In the following, the estimation/identification of the standard deviations of possible intersection coordinates of trajectories for both the robot-robot and human-robot combinations by means of the sigma-point technique is discussed.The following method is based on the unscented Kalman filter technique where the intersections cannot be directly measured but predicted/computed only.Nevertheless, it is possible to compute the variance of the predicted events, such as possible collisions or planned rendezvous situations, by a direct propagation of statistical parameters-the sigma points-through the nonlinear geometrical relation, which is a result of the crossing of two trajectories.Let x = (x 1 , x 2 ) T -the input vector and x c = (x c1 , x c2 ) T -the output vector where for the special case (x 1 , x 2 ) T = (ϕ R , ϕ H ) T and (x c1 , x c2 ) T = (x c , y c ) T .The nonlinear relation between x and x c is given by (34) For the discrete case, we obtain for the state and for the measured output z c (k) where w and v are the system noise and measurement noise, respectively.h(x c ) is the output nonlinearity.Furthermore, let there be the following: x(k)-the mean at time t k ; P(k)-the covariance matrix; x 0 -the initial state with the known mean µ 0 = E(x 0 );

Selection of Sigma Points
Sigma points are the selected parameters of a given error distribution of a random variable.Sigma points lie along the major eigen-axes of the covariance matrix of the random variable.The height of each sigma point (see Figure 7) represents its relative weight W j used in the following selection procedure.Let X(k − 1) be a set of 2n + 1 sigma points where n is the dimension of the state space (in our example, n = 2).
Consider the following selection of sigma points under the following condition 2n α and κ are scaling factors.A usual choice is α = 10 −2 and κ = 0. n 1−W 0 P(k − 1) is the row/column of the matrix square root of n 1−W 0 P. The square root of a matrix P is the solution S for P = S • S, which is obtained by Cholesky factorization.

Model Forecast Step
To go on with the UKF, the following step is devoted to the model forecast.In this way, the sigma points x j (k) are propagated through the nonlinear process model where the superscript f means "forecast".From these transformed and forecasted sigma points, the mean and covariance for the forecast value of x c (k) are

Measurement Update Step
In this step, the sigma points are propagated through the nonlinear observation model from which we obtain the mean and covariance (innovation covariance) and the cross-covariance

Data Assimilation Step
In this step, the forecast information is combined with the new information from the output z(k) from which we obtain, with the Kalman filter, gain K The gain K is given by and the posterior covariance is updated by Usually, it is sufficient to compute the mean and variance for the output/state x c of the nonlinear static system F(x).In this case, it is possible to stop further computing at Equation (42), meaning to rather calculate the transformed sigma points x f ,j c and develop the specific output means and variances from (41) and (42).In this connection, it is enough to substitute the covariance matrix Q into (38) instead of P. One advantage of the sigmapoint approach prior to statistical linearization is the easy scalability to multi-dimensional random variables.

Sigma Points-Fuzzy Solutions
In order to lower the computing effort, the application of the TS fuzzy interpolation may be a solution, which will be shown in the following.Having a look at the two-dimensional problem, we can see a nonlinear propagation of the input sigma points through a nonlinear function F. Let x j be the two-dimensional "input" sigma points or for the special case "intersection" The propagation through F leads to the "output" sigma points or for the special case The special nonlinear function F is described by (see ( 5)) where A RH is a nonlinear matrix (6) linearly combined with the position vector A fuzzification aims at A RH : Applied to the sigma points (ϕ j R , ϕ j H ), we obtain a TS fuzzy model described by the following rules R l 1 ,l 2 R l 1 ,l 2 : (55) are fuzzy terms for ϕ j R , ϕ j H ; the matrices A RH are functions of the predefined variables ϕ j R and ϕ j H .This set of rules leads to the result H ) can be computed off-line.Then, the calculation of the mean and covariance matrix is obtained by From the covariance P f , the variances σ c xx , σ cyy , σ c xy can be obtained )

Inverse Solution
The inverse solution for the sigma-point approach is much easier to obtain than that for the statistical linearization method.Starting from Equation (34), we build the inverse function on the condition that F −1 exists.Then, the covariance matrix P is defined in correspondence to the required variances σ c xx , σ cyy and σ c xy .The following steps correspond to Equations (34)-(42).The position vector x RH is assumed to be known.The inversion of F requires a linearization of x RH and a starting point to obtain a stable convergence to the inverse F −1 .The result is the mean x and the covariance Q at the input.A reliable inversion is only possible for the 2-input-2-output case.

Six-Inputs-Two-Outputs
This case works exactly as the 2-input-2-output case along with Equations (34)-(42) due to the fact that the computation of the sigma points (38)-(40) and the propagation through the nonlinearity F automatically include the input and output dimensions.

Simulation Results
The following simulations show the results of the uncertainties of the predicted intersections based on statistical linearization and sigma-point transformation.For both methods, identical parameters are employed for comparison reasons (see Figure 2).The position/orientation of the robot and human are given by the following: ϕ R and ϕ H are corrupted by Gaussian noise with standard deviations (std) of σ ϕ R = σ x 1 = 0.02 rad, (= 1.1 • ), and σ ϕ H = σ x 2 = 0.02 rad, (=1.1 • ) .

Statistical Linearization
Table 1 shows a comparison of the non-fuzzy method with the fuzzy approach using sectors of 60 • , 30 • , 15 • , 7.5 • of the unit circle for the orientations of the robot and human.The notations in Table 2 are as follows: σ x c -std-computed, σ x m -std-measured, etc.As expected, we see that higher resolutions lead to a better match between the fuzzy and analytical approach.Furthermore, the match between the measured and calculated values depends on the form of membership functions (MFS).For example, low input standard deviations (0.02 rad) show a better match for Gaussian membership functions, and higher input standard deviations (0.05 rad = 2.9 • ) require Gaussian bell-shaped membership functions, which comes from different smoothing effects (see columns 4 and 5 in Table 2).
A comparison of the control surfaces and corresponding measurements x cm , y cm (black and red dots) is depicted in Figures 8-10. Figure 8 shows the control surface of x c and y c for the non-fuzzy case (4).The control surfaces of the fuzzy approximations (7) for the 30 • and 7.5 • sectors are shown in Figures 9 and 10.The resolution 30 • (Figure 9) shows a very high deviation compared to the non-fuzzy approach (Figure 8), which decreases further down to the resolution 7.5 • (Figure 10).This explains the high differences between the measured and computed standard deviations and correlation coefficients, in particular for sector sizes of 30 • and higher.

Two-inputs-two-outputs:
The simulation of the sigma-point method is based on a Matlab implementation of an unscented Kalman filter by [25].The first example deals with the 2-inputs-2-outputs case in which only the orientations are taken into account, but the disturbances of the positions of the robot and human are not part of the sigma-point calculation.A comparison between the computed and measured covariance shows a very good match.The same holds for the standard deviations σ x c , σ y c .A comparison with the statistical linearization shows a good match as well (see Table 2, rows 1 and 2).
A view at the sigma points presents the following results: Figure 11 shows the twodimensional distribution of the orientation angles (ϕ R , ϕ H ) and the corresponding sigma points s 1 , . . ., s 5 where s 1 denotes the mean value.Figure 12 shows the two-dimensional distribution of the intersection coordinates (x c , y c ) with the sigma points S 1 , . . ., S 5 .S 1 denotes the mean value and S 1 , . . ., S 5 are distributed in such a way that the s i are transformed into S i , i = 1 . . . 5. From both figures, an optimal selection of both s 1 , . . ., s 5 and S 1 , . . ., S 5 can be observed, which results in a good match of the computed and measured standard deviations σ x c .

Six-inputs-two-outputs:
The 6-inputs-2-outputs example shows that the additional consideration of 4 input position coordinates with σ x R = 0.02 leads to similar results both for the computed and measured covariances and between the sigma-point method and statistical linearization (see P(7, 7) = σ  2 shows the covariance submatrix considering the output positions only.
They change their values every second according to the direction of motion.
From both plots, one observes an expected decrease in the output standard deviations for a mutual decrease in their distances to the specific intersection and a good match between the computed and measured values x c (see Table 3).With the information about the distance of the robot and the standard deviation from and at the expected intersection, respectively, it becomes possible to plan either an avoidance strategy or mutual cooperation between the robot and human.

Summary and Conclusions
The content of this work is the prediction of encounter situations of mobile robots and human agents in shared areas by analyzing planned/intended trajectories in the presence of uncertainties and system and observation noise.In this context, the problem of intersections of trajectories with respect to system uncertainties and Gaussian noise of the position and orientation of the agents involved is discussed.The problem is addressed by two methods: the statistical linearization of distributions and the sigma-point transformation of the distribution parameters.The positions and orientations of the robot and human are corrupted with Gaussian noise represented by the parameters' mean and standard deviation.The goal is to calculate the mean and standard deviation/variation at the intersection via the nonlinear relation between the positions/orientations of the robot and human, on the one hand, and the position of the intersection of their intended trajectories, on the other hand.
This analysis is realized by the statistical linearization of the nonlinear relation between the statistics of the robot and human (input) and the statistics of the intersection (output).The output results are the mean and standard deviation of the intersection as functions of the input parameters' mean and standard deviation of the positions and orientations of robot and human.This work is first carried out for two-input-two-output relations (two orientations of the robot-human and two intersection coordinates) and then for six inputs-two outputs (two orientations and four position coordinates of the robot-human and two intersection coordinates).These cases were extended to their fuzzy versions by different Takagi-Sugeno (TS) fuzzy approximations and compared with the non-fuzzy case.Up to a certain resolution, the approximation works as accurately as the original nonfuzzy version.For the two-input-two-output case, an inverse solution is derived, except for the six-input-two-output case because of the undetermined nature of the differential input-output relation.
The sigma-point transformation aims at transforming/propagating distribution parameters-the sigma points-directly through nonlinearities.The transformed sigma points are then converted into the distribution parameters' mean and covariance matrix.The sigma-point transformation is closely connected to the unscented Kalman filter, which is used in the example of the robot and human in motion.The specialty of the example is a computed virtual system output ("observation")-the intersection of two intended trajectories-where the corresponding output uncertainty is a sum of the transformed position/orientation noise and the computational uncertainty from the fuzzy approximation.In total, the comparison between the computed and measured covariances shows a very good match and the comparison with the statistical linearization shows good coincidences as well.Both the sigma-point transformation and the differential statistical linearization scales for more than two variables linearly.Their computational complexity is in the same order [13].However, if the model is nonlinear, then the differential linearization (EKF) serves as the first-order or second-order approximating estimator.If the system is highly nonlinear, the EKF may diverge and the sigma-point approach produces typically better results.In summary, a prediction of the accuracy of human-robot trajectories using the methods presented in this work increases the performance of human-robot collaboration and human safety.In future work, this method can be used for robot-human scenarios in factory workshops and for robots working in complicated environments like rescue operations in cooperation with human operators.

Figure 7 .
Figure 7. Sigma points for a 2-dim Gaussian random variable.

Figure 11 .
Figure 11.Sigma points, input, units of ϕ R and ϕ H in rad.

Table 1 .
Standard deviations and fuzzy and non-fuzzy results.

.711 0.635 0.592 Figure
8. Control surface non-fuzzy, units of ϕ R and ϕ H in rad.
Figure14shows the corresponding time plot.The time steps t 1 . . .t 5 are taken at 0.58 s, . . ., 4.58 s with a time distance of 1 s, which is 25 time steps of 0.04 s each.The robot and human start at