C++ (Cpp) urg_step2index示例

示例#1

文件： get_multiecho.c 项目： Fuzyou/urg

static void print_data(urg_t *urg, long data[], int data_n, long time_stamp)
{
#if 1
    int front_index;

    (void)data_n;

    // 前方のデータのみを表示
    front_index = urg_step2index(urg, 0);
    print_echo_data(data, front_index);
    printf("%ld\n", time_stamp);

#else
    (void)urg;

    int i;

    // 全てのデータを表示
    printf("# n = %d, time_stamp = %ld\n", data_n, time_stamp);
    for (i = 0; i < data_n; ++i) {
        print_echo_data(data, i);
        printf("\n");
    }
#endif
}

示例#2

文件： get_distance.c 项目： MichiganTechRoboticsLab/SensorDataCollector

static void print_data(urg_t *urg, long data[], int data_n, long time_stamp)
{
#if 1
    int front_index;

    (void)data_n;

    front_index = urg_step2index(urg, 0);
    printf("%ld [mm], (%ld [msec])\n", data[front_index], time_stamp);

#else
    (void)time_stamp;

    int i;
    long min_distance;
    long max_distance;

    urg_distance_min_max(urg, &min_distance, &max_distance);
    for (i = 0; i < data_n; ++i) {
        long l = data[i];
        double radian;
        long x;
        long y;

        if ((l <= min_distance) || (l >= max_distance)) {
            continue;
        }
        radian = urg_index2rad(urg, i);
        x = (long)(l * cos(radian));
        y = (long)(l * sin(radian));
        printf("(%ld, %ld), ", x, y);
    }
    printf("\n");
#endif
}

示例#3

文件： get_multiecho.c 项目： CIUTeamA/LaserLibrary

static void print_data(urg_t *urg, long data[], int data_n, long time_stamp)
{
#if 1
    int front_index;

    (void)data_n;

    // Shows only the front step
    front_index = urg_step2index(urg, 0);
    print_echo_data(data, front_index);
    printf("%ld\n", time_stamp);

#else
    (void)urg;

    int i;

    // Prints the multiecho distance for all the measurement points
    printf("# n = %d, time_stamp = %ld\n", data_n, time_stamp);
    for (i = 0; i < data_n; ++i) {
        print_echo_data(data, i);
        printf("\n");
    }
#endif
}

示例#4

文件： get_multiecho.cpp 项目： satofumi/quick_robot_sdk

static void print_data(urg_t *urg, long data[], int data_n, long time_stamp)
{
#if 1
    (void)data_n;

    // \~japanese 前方のデータのみを表示
    int front_index = urg_step2index(urg, 0);

    // [mm], [mm], [mm], [msec]
    printf("%ld, %ld, %ld, %ld\n",
           data[(3 * front_index) + 0],
           data[(3 * front_index) + 1],
           data[(3 * front_index) + 2],
           time_stamp);

#else
    int i;

    // \~japanese 全てのデータを表示
    printf("# n = %d, time_stamp = %d\n", data_n, time_stamp);
    for (i = 0; i < data_n; ++i) {

        // [mm], [mm], [mm]
        printf("%ld, %ld, %ld\n",
               data[(3 * i) + 0], data[(3 * i) + 1], data[(3 * i) + 2]);
    }
    printf("\n");
#endif
}

示例#5

文件： get_distance.c 项目： andreig1089/proiect_SLAM

static void print_data(urg_t *urg, long data[], int data_n, long time_stamp)
{
#if 1
    int front_index;

    (void)data_n;

    // \~japanese 前方のデータのみを表示
    front_index = urg_step2index(urg, 0);
    printf("%ld [mm], (%ld [msec])\n", data[front_index], time_stamp);

#else
    (void)time_stamp;

    int i;
    long min_distance;
    long max_distance;
    
    //open .txt file an write data into it
    //FILE *fp;
    //char ch;
    //fp=fopen("result.txt","w");
    // \~japanese 全てのデータの X-Y の位置を表示
    urg_distance_min_max(urg, &min_distance, &max_distance);
    for (i = 0; i < data_n; ++i) {
        long l = data[i];
        double radian;
        long x;
        long y;

        if ((l <= min_distance) || (l >= max_distance)) {
            continue;
        }
        radian = urg_index2rad(urg, i);
	printf("%5.5f,%ld\n", radian/**180/3.141565*/, l+20);
	//putc(radian*180/3.141565,fp);
	//putc(l,fp);
        //x = (long)(l * cos(radian));
        //y = (long)(l * sin(radian));
	//printf("(%ld, %ld), ", x, y);
    }
    //fclose(fp);
    printf("\n");
#endif
}

示例#6

文件： get_distance_intensity.c 项目： Fuzyou/urg

static void print_data(urg_t *urg, long data[], unsigned short intensity[],
                       int data_n, long time_stamp)
{
#if 1
    int front_index;
    (void)data_n;

    // 前方のデータのみを表示
    front_index = urg_step2index(urg, 0);
    printf("%ld [mm], %d [1], (%ld [msec])\n",
           data[front_index], intensity[front_index], time_stamp);

#else
    (void)urg;

    int i;

    // 全てのデータを表示
    printf("# n = %d, time_stamp = %ld\n", data_n, time_stamp);
    for (i = 0; i < data_n; ++i) {
        printf("%d, %ld, %d\n", i, data[i], intensity[i]);
    }
#endif
}