Possible mistake in add_pose2d method of class Visualizer

[tyagi-ankit]

Method add_pose2d in class Visualizer can be called for particles as well as robot. But in last two lines of the method, after comment "Draw line indicating heading", it uses robot_arrow_length. This will give wrong result when add_pose2d is called for particles.