%% Interpolate Between States in SE(3)
% Create an SE(3) state space with default properties.

space = stateSpaceSE3

% Create a pair of states in 3-D space.

state1 = [2 10 3 0.2 0 0 0.8];
state2 = [0 -2.5 4 0.7 0.3 0 0];

% Interpolate halfway between two states.

state = interpolate(space,state1,state2,0.5)

% Interpolate multiple points with a fixed interval.

states = interpolate(space,state1,state2,0:0.02:1)

% Copyright 2020 The MathWorks, Inc.