added utils and a lookup for joint inds in the message joint state
added author info and #defines for the headers