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

space = stateSpaceSE2

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

state1 = [2 10 -pi];
state2 = [0 -2.5 -pi/4];

% 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 2019 The MathWorks, Inc.