Linearly interpolate in joint space to get initial trajectory.
Make viewer configurable by a ros parameter.
Use namespace std because everyone knows where vectors and iostreams came from.