ROS2 C++开发系列08-传感器数据缓存与指令解析方式之数组、向量与字符串实战

3 阅读7分钟

📺 配套视频:ROS2 C++开发系列08-传感器数据缓存与指令解析方式之数组、向量与字符串实战

在机器人 C++ 开发中,高效地管理传感器读数、电机指令以及文本配置是基础且核心的技能。本教程将深入探讨三种最常用的数据结构:固定大小的数组(Array)、动态灵活的向量(Vector)以及用于处理文本的字符串(String)。我们将通过具体的代码示例,展示如何声明、初始化、访问和修改这些数据,并介绍相关的字符处理函数。

一、 静态数组:固定大小的数据存储

数组是 C++ 中最基础的数据结构,适用于存储已知数量且类型相同的元素。在机器人应用中,它常用于存储固定数量的传感器读数或预设的配置参数。由于数组大小在编译时确定,其内存分配是连续的,访问速度极快,但缺乏灵活性。

1. 数组的声明与初始化

首先,我们需要定义一个常量来表示数组的大小,这有助于提高代码的可维护性。接着声明整数类型的数组,并使用 for 循环进行批量初始化。

#include <iostream>
using namespace std;

int main() {
    // 定义数组大小,使用 const 保证不可变性
    const int size = 5;
    
    // 声明大小为 size 的整数数组
    int sensorReadings[size];
    
    // 使用 for 循环初始化数组元素
    // 每个元素的值为其索引乘以 10
    for (int i = 0; i < size; i++) {
        sensorReadings[i] = i * 10;
    }
    
    // ... 后续访问逻辑
}

在上述代码中,sensorReadings 被初始化为 [0, 10, 20, 30, 40]。这种基于索引的计算初始化方式非常适合模拟线性变化的传感器数据。

2. 访问与遍历数组

数组的元素通过方括号 [] 内的索引进行访问,索引从 0 开始。为了打印所有元素,我们再次使用 for 循环遍历数组。

    // 遍历并打印数组元素
    for (int i = 0; i < size; i++) {
        cout << "Sensor " << (i + 1) 
             << ": " << sensorReadings[i] << endl;
    }
    
    return 0;
}

运行上述代码,终端将输出传感器 1 到 5 的读数。需要注意的是,C++ 不会自动检查数组越界。如果尝试访问 sensorReadings[5] 或更大索引,会导致未定义行为(Undefined Behavior),可能引发程序崩溃或数据损坏。因此,始终确保索引在 0size - 1 的有效范围内。

易错点:数组大小必须在编译时确定(或使用变量但需符合编译器扩展规则),且不能像 Python 列表那样随意增减元素。

二、 动态向量:灵活的数据容器

当面对可变数量的数据,如不断增长的传感器日志或动态任务队列时,固定大小的数组显得力不从心。C++ 标准库提供的 std::vector 是一种动态数组容器,它能在运行时自动管理内存,支持在末尾高效地添加或删除元素。

1. 向量的声明与元素添加

使用向量前,必须包含 <vector> 头文件。我们可以通过 push_back() 方法将元素逐个添加到向量末尾。

#include <iostream>
#include <vector> // 引入 vector 头文件
using namespace std;

int main() {
    // 声明整型向量,初始为空
    vector<int> motorSpeeds;
    
    // 使用 push_back 动态添加元素
    motorSpeeds.push_back(100);
    motorSpeeds.push_back(200);
    motorSpeeds.push_back(150);
    
    // ... 后续访问逻辑
}

push_back 操作的时间复杂度通常为均摊 O(1)O(1),这使得它在处理大量数据追加时非常高效。

2. 获取大小与遍历访问

向量提供了 .size() 成员函数来返回当前元素的数量,这在遍历时至关重要,因为向量大小是动态变化的。

    // 使用 size() 获取向量长度并遍历
    for (size_t i = 0; i < motorSpeeds.size(); i++) {
        cout << "Motor " << (i + 1) 
             << " speed: " << motorSpeeds[i] << endl;
    }
    
    return 0;
}

这里使用了 size_t 作为循环变量类型,因为 .size() 返回的是无符号整数类型,使用 int 可能会触发编译器警告。运行结果将依次打印出三个电机的速度值。在机器人项目中,向量可用于存储轨迹点、任务列表或实时堆叠的传感器数据。

小结:相比数组,向量牺牲了少量的内存效率以换取极大的灵活性。只要记得包含 <vector> 头文件,它就是处理未知规模数据的最佳选择。

三、 字符串操作:文本数据处理

在机器人交互中,字符串(std::string)用于处理名称、命令消息和配置文件。C++ 的 std::string 类提供了丰富的接口,使其比传统的 C 风格字符数组更易于使用和安全。

1. 声明、访问与修改

字符串可以像数组一样通过索引访问单个字符。我们可以读取特定位置的字符,也可以直接修改该位置的字符。

#include <iostream>
#include <string> // 引入 string 头文件
using namespace std;

int main() {
    // 声明并初始化字符串
    string robot_name = "Automatic Addison Bot";
    
    // 输出完整名称
    cout << "Robot Name: " << robot_name << endl;
    
    // 访问第一个字符(索引为 0)
    cout << "First char: " << robot_name[0] << endl;
    
    // 修改第 8 个字符(索引为 8),将 '.' 改为 '-'
    // 注意:字符串索引从 0 开始
    robot_name[8] = '-';
    
    cout << "Modified Name: " << robot_name << endl;
    
    return 0;
}

运行后,你会看到原始名称中的点号被替换为连字符。这种直接修改能力使得字符串在处理格式化输出时非常便捷。

2. 字符串拼接

使用加号运算符 + 可以轻松地将多个字符串连接在一起。

    string model = "X100";
    // 拼接机器人名称、空格和型号
    string full_name = robot_name + " " + model;
    
    cout << "Full Name: " << full_name << endl;

最终输出的 full_name 将是 "Automatic-Addison Bot X100"。字符串拼接是构建复杂日志消息或指令参数的常用手段。

四、 字符函数:分析与转换

除了整体操作字符串,有时我们需要对单个字符进行分析,例如验证用户输入的命令是否合法,或将小写指令转换为大写以便统一处理。这需要借助 <cctype> 头文件中提供的字符处理函数。

1. 常见字符函数

  • islower(char): 检查字符是否为小写字母,若是则返回非零值(真)。
  • toupper(char): 将小写字母转换为大写,其他字符保持不变。
  • 相等运算符 ==: 用于比较两个字符是否相同。

2. 实战示例

以下代码演示了如何检查字符属性并进行大小写转换。

#include <iostream>
#include <cctype> // 引入字符处理函数库
using namespace std;

int main() {
    char command = 'f';
    
    // 检查是否为小写
    if (islower(command)) {
        cout << "Command is lowercase." << endl;
    }
    
    // 转换为大写
    char uppercaseCommand = toupper(command);
    cout << "Uppercase Command: " << uppercaseCommand << endl;
    
    // 比较字符
    if (command == 'f') {
        cout << "Command is f." << endl;
    }
    
    return 0;
}

输出结果将显示命令是小写的,转换后的大写形式为 'F',并确认命令确实是 'f'。在机器人控制中,这类函数常用于预处理传感器信号或过滤无效的用户输入。

关键提示:使用字符函数时务必包含 <cctype>,否则编译器将无法识别 islower 等函数。此外,这些函数通常只针对 ASCII 字符集优化,处理 Unicode 时需额外注意。

速查表

数据结构适用场景关键操作/函数注意事项
数组 (Array)固定数量、高性能访问的数据arr[i], const int size大小固定,需手动管理边界,防越界
向量 (Vector)动态增长、频繁增删的数据vec.push_back(), vec.size()#include <vector>,内存自动管理
字符串 (String)文本消息、名称、配置str[i], str + str, getline#include <string>,支持直接修改字符
字符函数输入验证、格式标准化islower(), toupper()#include <cctype>,仅处理单字符