Added additional functionalities to ScenePublisher

Basically three new functions, which allows to spawn in rviz the following geometrical shapes:

Polygon
Filled Polygon
Sphere