Added new size option, Eigen poses for publishArrow
Improved publishSphere function, added Black, fixed small bugs
Created new line publisher, rectangle publisher, new colors, and setAlpha
merged