adding link and robot folders, added a traj gen

Trajectory generator is in progress.  It plots the points that the robot
needs to hit to make the 3D plot.  Still need to output the plot into a
.mat file.