%% Bend the Knees %%

END = 8;

% setup vars
t         = 0 : 1 : END;
pos_hip   = [0, -1, 0, 0, 0, 0, 0, 0, 0];
pos_knee  = [0, 2, 0, 0, 0, 0, 0, 0, 0];
pos_ankle = [0, -0.5, 0, 0, 0, 0, 0, 0, 0];

% generate graph lines
querypts_hip   = 0 : 0.001 : END;
querypts_knee  = 0 : 0.001 : END;
querypts_ankle = 0 : 0.001 : END;

interpts_hip   = interp1(t, pos_hip, querypts_hip, 'spline')';
interpts_knee  = interp1(t, pos_knee, querypts_knee, 'spline')';
interpts_ankle = interp1(t, pos_ankle, querypts_ankle, 'spline')';

ret_LHip   = [querypts_hip', interpts_hip];
ret_LKnee  = [querypts_knee', interpts_knee];
ret_LAnkle = [querypts_ankle', interpts_ankle];

ret_RHip    = [querypts_hip', interpts_hip];
ret_RKnee   = [querypts_knee', interpts_knee];
ret_RAnkle = [querypts_ankle', interpts_ankle];

% create graph
%figure
%plot(t, p,'o', querypts, interpts, ':.');