function CameraInterpolation

R1 = eye(3);
C1 = [0;0;0];

q2 = 2*(rand(4,1)-0.5);
R2 = Quaternion2Rotation(q2);
C2 = 2*rand(3,1);

[Rset, Cset] = InterpolateCoordinate(R1, C1, R2, C2, 20);

figure(1)
clf;
for i = 1 : length(Rset)
    hold on
    DisplayCamera(Cset(:,i), Rset{i}, 0.05);
end
hold on
plot3(Cset(1,:), Cset(2,:), Cset(3,:), '-', 'Color', [0.1 0.1 0.1]);
hold on
plot3(C1(1), C1(2), C1(3), 'k.', 'MarkerSize', 30);
hold on
plot3(C2(1), C2(2), C2(3), 'k.', 'MarkerSize', 30);

axis equal
