给这段代码增加 输入c 拍照的功能

好的，可以在代码的末尾添加以下内容来实现拍照功能：

#include <string.h>
#include <fcntl.h>

int take_picture(void) {
    char filename[32];
    sprintf(filename, "picture-%ld.jpg", time(NULL));
    int fd = open(filename, O_WRONLY | O_CREAT, 0644);
    if (fd < 0) {
        fprintf(stderr, "Can not create file: %s\n", filename);
        return -1;
    }
    system("gst-launch-1.0 v4l2src device=/dev/video51 io-mode=4 ! video/x-raw,format=NV12,width=720,height=576,framerate=15/1 ! jpegenc ! filesink location=picture.jpg > /dev/null 2>&1");
    char cmd[128];
    sprintf(cmd, "cat picture.jpg >> %s", filename);
    system(cmd);
    printf("Picture saved to: %s\n", filename);
    close(fd);
    return 0;
}

int main(void) {
    // 设置环境变量
    setenv("DISPLAY", ":0.0", 1);
    setenv("XDG_RUNTIME_DIR", "/run/user/1000", 1);

    // 检查摄像头设备文件是否存在
    if (access("/dev/video51", F_OK) == 0) {
        // 启动 pipeline
        system("gst-launch-1.0 v4l2src device=/dev/video51 io-mode=4 ! video/x-raw,format=NV12,width=720,height=576,framerate=15/1 ! xvimagesink > /dev/null 2>&1 &");
    } else if (access("/dev/video31", F_OK) == 0) {
        // 启动 pipeline
        system("gst-launch-1.0 v4l2src device=/dev/video31 io-mode=4 ! video/x-raw,format=NV12,width=720,height=576,framerate=15/1 ! xvimagesink > /dev/null 2>&1 &");
    } else if (access("/dev/video11", F_OK) == 0) {
        // 启动 pipeline
        system("gst-launch-1.0 v4l2src device=/dev/video11 io-mode=4 ! video/x-raw,format=NV12,width=720,height=576,framerate=15/1 ! xvimagesink > /dev/null 2>&1 &");
    } else {
        fprintf(stderr, "Can not find camera!!!\n");
        return 1;
    }

    printf("MIPI CSI Camera Preview started!\n");

    // 循环等待用户输入，按下 'c' 键时拍照并保存
    while (1) {
        char c = getchar();
        if (c == 'c') {
            take_picture();
        }
    }

    return 0;
}

这里新增了一个名为 `take_picture()` 的函数，它的作用是拍照并将图片保存到文件中。在 `main()` 函数中，我们使用一个无限循环来等待用户输入，当用户按下 'c' 键时就会调用 `take_picture()` 函数来拍照。在 `take_picture()` 函数中，我们使用 GStreamer 的 `jpegenc` 插件将摄像头的画面编码为 JPEG 格式，并将编码后的数据保存到 `picture.jpg` 文件中。然后再将这个文件追加到一个以当前时间命名的文件中，最后打印出保存文件的路径。