how to make line strip marker

edit

Hi,

I am using Ubuntu 12.04 with Hydro.

With reference to Points and Lines tutorial and Basic Shapes, I tried to create marker to each goal i send on rviz.

Essentially, I am trying to record and visualize all the goals i have sent and delete the goal i clicked for the second time. The points are working fine, while the lines are not showing up. Following is my code:

Class createMarker;

void Class::goalcb(const geometry_msgs::PoseStamped::ConstPtr&  waypoint)
{
  check = false;
  x.push_back (waypoint->pose.position.x);
  y.push_back (waypoint->pose.position.y);

  for (int count = 0; count < x.size(); count ++)
  printf("Starting Count%u X = %f, Y = %f \n", count, x[count], y[count]);

  cout << "Sample 1 ="<< x.size() << endl;
  for (int count = 0; count < x.size(); count ++)
  {
    printf("Y count = %f, Y que = %f\n", y[count], y[que]);     
    if ( count!=que && x[count]<(x[que]+0.05) && x[count]>(x[que]-0.05) && y[count]<(y[que]+0.05) && y[count]>(y[que]-0.05) )
    {

      Point = count;
      printf("X = %f\n", x[count]);
      reaction = visualization_msgs::Marker::DELETE;
      x.erase(x.begin() + count);
      y.erase(y.begin() + count);
      //createMarker.makeMarker();

      check = true;
/**   x.erase(x.begin() + que);
      y.erase(y.begin() + que);*/

      printf("Value of point %u is erased\n", count);
      printf("X after erased = %f\n", x[count]);
    }

    cout << "Sample 2 ="<< x.size() << endl;
    Point = count;

    if (check = true && count == x.size())
    reaction = visualization_msgs::Marker::DELETE;    
    else
    reaction = visualization_msgs::Marker::ADD;

    createMarker.makeMarker();
    vector<float>::const_iterator xii, yii;
    xii = x.begin() + que;
    yii = y.begin() + que;
    cout << "X end =" << *xii << endl;
    cout << "Y end =" << *yii << endl;
    //printf("X end = %d, Y end = %d\n", x.end(), y.end());
  }
  printf("\n************************************\n");
  for (int count = 0; count < x.size(); count ++)
  printf("Point%u X = %f, Y = %f \n", count, x[count], y[count]);
  printf("************************************\n");
  if (check)
  que --;
  else
  que ++;

  return;
}

void Class::makeMarker()
{

    visualization_msgs::Marker points, line_strip;
    // Set the frame ID and timestamp.  See the TF tutorials for information on these.
    points.header.frame_id = line_strip.header.frame_id = "/map";
    points.header.stamp = line_strip.header.stamp = ros::Time::now();

    // Set the namespace and id for this marker.  This serves to create a unique ID
    // Any marker sent with the same namespace and id will overwrite the old one
    points.ns = "Points";
    line_strip.ns = "Lines";
    points.id = line_strip.id = Point; //trying out

    // Set the marker type.  Initially this is CUBE, and cycles between that and SPHERE, ARROW, and CYLINDER
    points.type = visualization_msgs::Marker::POINTS;
    line_strip.type = visualization_msgs::Marker::LINE_STRIP;

    // Set the marker action.  Options are ADD and DELETE   
    points.action = line_strip.action = reaction;//visualization_msgs::Marker::ADD;

    if (reaction == visualization_msgs::Marker::DELETE)
    printf("Point %u is deleted\n", Point);
    else
    printf("making marker %u at x = %f, y = %f\n", Point, x[Point], y[Point]);

    // Set the pose of the marker.  This is a full 6DOF pose relative to the frame/time specified in the header
    geometry_msgs::Point p;
    p.x = x[Point];
    p.y = y[Point];
    p.z ...