冷靜

2025年7月1日星期二

FN920C04 PCIE on X86_64

Kernel: 6.9.12

Modify Kernel Code
a. pci_generic.c
b. kernel config

$ grep -i "mhi" ./config-6.9.12
CONFIG_QRTR_MHI=m
# CONFIG_PCI_EPF_MHI is not set
CONFIG_MHI_BUS=m
CONFIG_MHI_BUS_DEBUG=y
CONFIG_MHI_BUS_PCI_GENERIC=m
CONFIG_MHI_BUS_EP=m
CONFIG_MHI_NET=m
CONFIG_MHI_WWAN_CTRL=m
CONFIG_MHI_WWAN_MBIM=m

c. lspci

$ lspci -nn
03:00.0 Unassigned class [ff00]: Qualcomm Device [17cb:011a]

$ lspci -k
03:00.0 Unassigned class [ff00]: Qualcomm Device 011a
        Subsystem: Device 1c5d:2020
        Kernel driver in use: mhi-pci-generic
        Kernel modules: mhi_pci_generic

d. dmesg

$ sudo dmesg | grep -i mhi
[    5.721867] mhi_pci_generic: module verification failed: signature and/or required key missing - tainting kernel
[    5.724379] mhi-pci-generic 0000:03:00.0: MHI PCI device found: telit-fn920c04
[    5.724387] mhi-pci-generic 0000:03:00.0: BAR 0 [mem 0xd0801000-0xd0801fff 64bit]: assigned
[    5.729509] mhi mhi0: Requested to power ON
[    5.729535] mhi mhi0: Power on setup success

e. device node

$ ls -alh /dev/wwan0*
crw------- 1 root root 242, 2  七   2 09:37 /dev/wwan0at0
crw------- 1 root root 242, 3  七   2 09:37 /dev/wwan0at1
crw------- 1 root root 242, 0  七   2 09:37 /dev/wwan0qcdm0
crw------- 1 root root 242, 1  七   2 09:37 /dev/wwan0qmi0

f. interface

$ ls /sys/class/net/
eno1  lo  mhi_hwip0


$ udevadm info /sys/class/net/mhi_hwip0
P: /devices/pci0000:00/0000:00:1c.0/0000:03:00.0/mhi0/mhi0_IP_HW0/net/mhi_hwip0
L: 0
E: DEVPATH=/devices/pci0000:00/0000:00:1c.0/0000:03:00.0/mhi0/mhi0_IP_HW0/net/mhi_hwip0
E: INTERFACE=mhi_hwip0
E: IFINDEX=3
E: SUBSYSTEM=net
E: USEC_INITIALIZED=5963171
E: ID_MM_CANDIDATE=1
E: ID_BUS=pci
E: ID_VENDOR_ID=0x17cb
E: ID_MODEL_ID=0x011a
E: ID_PCI_CLASS_FROM_DATABASE=Unassigned class
E: ID_VENDOR_FROM_DATABASE=Qualcomm
E: ID_PATH=pci-0000:03:00.0
E: ID_PATH_TAG=pci-0000_03_00_0
E: ID_NET_DRIVER=mhi_net
E: ID_NET_LINK_FILE=/usr/lib/systemd/network/99-default.link
E: ID_NET_NAME=mhi_hwip0
E: SYSTEMD_ALIAS=/sys/subsystem/net/devices/mhi_hwip0
E: TAGS=:systemd:
E: CURRENT_TAGS=:systemd:

FN920C04 FW version (要B022, B015有問題)

at#swpkgv
49.00.000-B022-P0V.130000
M0V.060000-B022
P0V.130000
A0V.000000-B022

qmicli+udhcpc, 但系統無法取得IP, 用ip route解決


#write profile in /etc/qmi-network.conf
    APN=INTERNET #CHT
    APN_USER=
    APN_PASS=
    PROXY=yes

$ qmicli -V
qmicli 1.32.0

$ sudo qmicli -d /dev/wwan0qmi0 --dms-set-operating-mode='online'
[/dev/wwan0qmi0] Operating mode set successfully


$ sudo ip link set wwan0 up


$ sudo qmicli -d /dev/wwan0qmi0 --wda-get-data-format
[/dev/wwan0qmi0] Successfully got data format
                   QoS flow header: no
               Link layer protocol: 'raw-ip'
  Uplink data aggregation protocol: 'disabled'
Downlink data aggregation protocol: 'disabled'
                     NDP signature: '0'
Downlink data aggregation max datagrams: '0'
Downlink data aggregation max size: '0'


$ sudo qmi-network /dev/wwan0qmi0 start
Loading profile at /etc/qmi-network.conf...
    APN: INTERNET
    APN user: unset
    APN password: unset
    qmi-proxy: yes
    IP_TYPE: unset
    PROFILE: unset
Checking data format with 'qmicli -d /dev/wwan0qmi0 --wda-get-data-format --device-open-proxy'...
Device link layer protocol retrieved: raw-ip
Getting expected data format with 'qmicli -d /dev/wwan0qmi0 --get-expected-data-format'...
error: cannot get expected data format: Setting expected data format management is unsupported by the driver
Expected link layer protocol not retrieved: kernel unsupported
Updating device link layer protocol with 'qmicli -d /dev/wwan0qmi0 --wda-set-data-format=802-3 --device-open-proxy'...
New device link layer protocol retrieved: raw-ip
Starting network with 'qmicli -d /dev/wwan0qmi0 --wds-start-network=apn='INTERNET'  --client-no-release-cid --device-open-proxy'...
Saving state at /tmp/qmi-network-state-wwan0qmi0... (CID: 15)
Saving state at /tmp/qmi-network-state-wwan0qmi0... (PDH: 3771166512)
Network started successfully


$ sudo qmicli -d /dev/wwan0qmi0 --wds-get-current-settings
[/dev/wwan0qmi0] Current settings retrieved:
           IP Family: IPv4
        IPv4 address: 10.169.211.193
    IPv4 subnet mask: 255.255.255.252
IPv4 gateway address: 10.169.211.194
    IPv4 primary DNS: 168.95.1.1
  IPv4 secondary DNS: 168.95.192.1
                 MTU: 1500
             Domains: none


$ sudo ip addr add 10.169.211.193/30 dev mhi_hwip0


$ ip route
10.169.211.192/30 dev mhi_hwip0 proto kernel scope link src 10.169.211.193



$ sudo ip route add default via 10.169.211.193


$ ifconfig mhi_hwip0
mhi_hwip0: flags=209<UP,POINTOPOINT,RUNNING,NOARP>  mtu 16384
        inet 10.169.211.193  netmask 255.255.255.252  destination 10.169.211.193
        inet6 fe80::200:ff:fe00:0  prefixlen 64  scopeid 0x20<link>
        unspec 00-00-00-00-00-00-00-00-00-00-00-00-00-00-00-00  txqueuelen 1000  (UNSPEC)
        RX packets 0  bytes 0 (0.0 B)
        RX errors 0  dropped 0  overruns 0  frame 0
        TX packets 6  bytes 288 (288.0 B)
        TX errors 0  dropped 0 overruns 0  carrier 0  collisions 0

$ ping -I mhi_hwip0 8.8.8.8
PING 8.8.8.8 (8.8.8.8) from 10.169.211.193 mhi_hwip0: 56(84) bytes of data.
64 bytes from 8.8.8.8: icmp_seq=1 ttl=114 time=432 ms
64 bytes from 8.8.8.8: icmp_seq=2 ttl=114 time=35.6 ms
64 bytes from 8.8.8.8: icmp_seq=3 ttl=114 time=32.7 ms
...
...

$ ping google.com
ping: google.com: Temporary failure in name resolution



$ echo "nameserver 168.95.1.1" | sudo tee /etc/resolv.conf
nameserver 168.95.1.1


$ ping google.com
PING google.com (142.250.198.78) 56(84) bytes of data.
64 bytes from lctsaa-ab-in-f14.1e100.net (142.250.198.78): icmp_seq=1 ttl=114 time=15.5 ms
64 bytes from lctsaa-ab-in-f14.1e100.net (142.250.198.78): icmp_seq=2 ttl=114 time=40.8 ms
64 bytes from lctsaa-ab-in-f14.1e100.net (142.250.198.78): icmp_seq=3 ttl=114 time=39.9 ms
...
...

ModemManager (FN920C04 PCIE是用 wwan0qmi0)

$ mmcli --version
mmcli 1.18.6
Copyright (2011 - 2021) Aleksander Morgado
License GPLv2+: GNU GPL version 2 or later <http://gnu.org/licenses/gpl-2.0.html>
This is free software: you are free to change and redistribute it.
There is NO WARRANTY, to the extent permitted by law.

$ mmcli -L
    /org/freedesktop/ModemManager1/Modem/0 [Telit Cinterion] FN920C04-WW

$ mmcli -m 0
  ----------------------------------
  General  |                   path: /org/freedesktop/ModemManager1/Modem/0
           |              device id: 6be85a5a4dfee78138924ac7c4fa075a8ebca546
  ----------------------------------
  Hardware |           manufacturer: Telit Cinterion
           |                  model: FN920C04-WW
           |      firmware revision: M0V.060000-B022
           |         carrier config: default
           |           h/w revision: 1.20
           |              supported: lte, 5gnr
           |                current: lte, 5gnr
           |           equipment id: 355411761011444
  ----------------------------------
  System   |                 device: /sys/devices/pci0000:00/0000:00:1c.0/0000:03:00.0
           |                drivers: mhi_net, mhi-pci-generic
           |                 plugin: generic
           |           primary port: wwan0qmi0
           |                  ports: mhi_hwip0 (net), wwan0at0 (at), wwan0at1 (at),
           |                         wwan0qmi0 (qmi)
  ----------------------------------
...
...
...
  ----------------------------------
  3GPP EPS |   ue mode of operation: csps-2
           |    initial bearer path: /org/freedesktop/ModemManager1/Bearer/0
           | initial bearer ip type: ipv4
  ----------------------------------
  SIM      |       primary sim path: /org/freedesktop/ModemManager1/SIM/0
           |         sim slot paths: slot 1: /org/freedesktop/ModemManager1/SIM/0 (active)
           |                         slot 2: none

troubleshooting
1. disable ModemManager and poweroff.

$ sudo qmicli -d /dev/wwan0qmi0 --dms-set-operating-mode='online'
[sudo] password for ubuntu:
[02  七  2025, 10:03:49] -Warning ** Error reading from istream: Resource temporarily unavailable
error: couldn't create client for the 'dms' service: CID allocation failed in the CTL client: endpoint hangup

2. 目前的FN920C04 FW(B22), 好像還不能使用ModemManager...升級1.24後再來試試

$ sudo mmcli -m 0 --create-bearer='apn=internet,ip-type=ipv4'
[sudo] password for ubuntu:
Successfully created new bearer in modem:
        /org/freedesktop/ModemManager1/Bearer/1

$ sudo mmcli -m 0 --simple-connect='apn=internet,ip-type=ipv4v6'
error: couldn't connect the modem: 'GDBus.Error:org.freedesktop.ModemManager1.Error.MobileEquipment.NetworkTimeout: Network timeout'

2025年5月22日星期四

Send SMS via AT commands

Module:
Telit LN920A06

def text_to_ucs2_hex(text):
    return text.encode('utf-16-be').hex().upper()

def encode_phone_number(number):
    # 處理台灣號碼，如 0966123456 → +886966123456
    if number.startswith('0'):
        number = '886' + number[1:]
    elif number.startswith('+'):
        number = number[1:]

    if len(number) % 2 != 0:
        number += 'F'

    swapped = ''.join([number[i+1] + number[i] for i in range(0, len(number), 2)])
    return swapped, len(number)

def generate_pdu_and_cmgs(phone, message):
    # UCS2 編碼
    ucs2 = text_to_ucs2_hex(message)
    ucs2_len = len(ucs2) // 2  # bytes

    # 編碼電話號碼
    phone_enc, phone_digits = encode_phone_number(phone)
    phone_len_hex = f"{phone_digits:X}".zfill(2)

    # 組合 PDU
    smsc = "00"
    pdu_type = "11"
    mr = "00"
    toa = "91"
    pid = "00"
    dcs = "08"
    vp = "AA"  # 約 4 天
    udl = f"{ucs2_len:02X}"

    pdu_body = (
        pdu_type + mr + phone_len_hex + toa + phone_enc +
        pid + dcs + vp + udl + ucs2
    )

    full_pdu = smsc + pdu_body

    # CMGS = 從 PDU_TYPE 開始的長度（即去掉 SMSC 的 "00" 開頭，長度為 1 byte = 2 hex）
    cmgs_len = (len(full_pdu) - 2) // 2

    return full_pdu, cmgs_len

# 測試
phone = "0966123456"
message = "哈囉世界"

pdu, cmgs_len = generate_pdu_and_cmgs(phone, message)
print(f"AT+CMGF=0")
print(f"AT+CMGS={cmgs_len}")
print(pdu)

ref:
1. GSM Modem 傳送簡訊的幾個 AT 指令
2. GPRS應用之: AT指令發送PDU簡訊詳解

2025年5月20日星期二

enable gnss_nmea for Le910Cx

Le910Cx開啟gnss nmea時，
用哪個ttyUSB開啟，就會直接輸出，加入下面條件，應該可以開機時，順利啟動NMEA
環境: NV Orin R36.3

avoid blocking ttyUSB2 by modemmanager

$ cat /etc/udev/rules.d/99-le910Cx.rules
KERNEL=="ttyUSB2", SUBSYSTEM=="tty", ENV{ID_VENDOR_ID}=="1bc7", ENV{ID_MODEL_ID}=="1031", ENV{ID_MM_DEVICE_IGNORE}="1"

。Setting ENV{ID_MM_DEVICE_IGNORE}="1" on a USB device or interface tells ModemManager to ignore all related ports.
。ENV{ID_MM_DEVICE_IGNORE}="1" tells ModemManager to ignore this port only.

enable_gnss.c (delay 5 secs)

#include <errno.h>
#include <fcntl.h>
#include <libudev.h>
#include <pthread.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <sys/time.h>
#include <termios.h>
#include <time.h>
#include <unistd.h>

#define TIMEOUT_MS 3000 // Timeout in milliseconds
#define MAX_BUFFER_SIZE 256
#define MAX_AT_RESPONSE 16
#define MAX_DEVICE_PATH 64 // Define a constant for device path size

// Structure to hold AT command and its response time
typedef struct {
  char command[32];
  double response_time;
} ATCommand;

// Structure to hold the AT command responses
typedef struct {
  char device_path[MAX_DEVICE_PATH]; // Use the defined constant
  char response[MAX_BUFFER_SIZE];
} DeviceResponse;

DeviceResponse device_responses[MAX_AT_RESPONSE];

pthread_mutex_t response_mutex = PTHREAD_MUTEX_INITIALIZER;
int response_count = 0;

// Function prototypes (for clarity)
int open_serial_port(const char *port_name);
int send_at_command(int fd, const char *command, char *response,
                    size_t response_size, double response_time);
void close_serial_port(int fd);
void *process_device(void *arg);
int find_tty_acm(int argc, char *argv[], int *get_count,
                 char dev_path[][MAX_DEVICE_PATH]); // Use the defined constant
void GetResponseData(char *input, char *output, size_t array_size,
                     int line_sopt);

ATCommand ATCS[] = {
    {"at$GPSP=1", 0.5}, // Example response time of 300ms (converted to seconds)
    {"AT$GPSNMUN=1,1,1,1,1,1,1", 0.4}, // Example response time of 400ms
};

int open_serial_port(const char *port_name) {
  int fd = open(port_name, O_RDWR | O_NOCTTY | O_NDELAY);
  if (fd == -1) {
    perror("open_serial_port: open failed");
    return -1;
  }

  struct termios tty;
  memset(&tty, 0, sizeof(tty));
  if (tcgetattr(fd, &tty) != 0) {
    perror("open_serial_port: tcgetattr failed");
    close(fd);
    return -1;
  }

  cfsetospeed(&tty, B115200); // Set baud rate (adjust as needed)
  cfsetispeed(&tty, B115200);

  tty.c_cflag &= ~PARENB; // No parity
  tty.c_cflag &= ~CSTOPB; // 1 stop bit
  tty.c_cflag &= ~CSIZE;
  tty.c_cflag |= CS8;            // 8 data bits
  tty.c_cflag &= ~CRTSCTS;       // No hardware flow control
  tty.c_cflag |= CREAD | CLOCAL; // Enable read and ignore control lines

  tty.c_lflag &= ~ICANON; // Disable canonical mode
  tty.c_lflag &= ~ECHO;   // Disable echo
  tty.c_lflag &= ~ECHOE;  // Disable erasure
  tty.c_lflag &= ~ECHONL; // Disable new-line echo
  tty.c_lflag &= ~ISIG;   // Disable interpretation of interrupt, quit, and
                          // suspend characters

  tty.c_iflag &= ~(IXON | IXOFF | IXANY); // Disable software flow control
  tty.c_iflag &= ~(IGNBRK | BRKINT | PARMRK | ISTRIP | INLCR | IGNCR |
                   ICRNL); // Disable special handling of received bytes

  tty.c_oflag &= ~OPOST; // Prevent special interpretation of output bytes
  tty.c_oflag &=
      ~ONLCR; // Prevent conversion of newline to carriage return/line feed

  tty.c_cc[VTIME] = TIMEOUT_MS / 100; // Timeout in deciseconds (correct)
  tty.c_cc[VMIN] = 0;                 // Minimum number of characters to receive

  if (tcsetattr(fd, TCSANOW, &tty) != 0) {
    perror("open_serial_port: tcsetattr failed");
    close(fd);
    return -1;
  }

  return fd;
}

int send_at_command(int fd, const char *command, char *response,
                    size_t response_size, double response_time) {
  tcflush(fd, TCIFLUSH); // Flush the input buffer

  ssize_t bytes_written = write(fd, command, strlen(command));
  if (bytes_written < 0) {
    perror("send_at_command: write failed");
    return -1;
  }

  memset(response, 0, response_size);
  size_t total_bytes_read = 0;

  struct timeval start_time, current_time;
  gettimeofday(&start_time, NULL); // Use gettimeofday for better precision

  while (total_bytes_read < response_size - 1) {
    ssize_t bytes_read = read(fd, response + total_bytes_read,
                              response_size - 1 - total_bytes_read);
    if (bytes_read < 0) {
      if (errno == EAGAIN || errno == EWOULDBLOCK) {
        gettimeofday(&current_time, NULL);
        double elapsed_time =
            (current_time.tv_sec - start_time.tv_sec) +
            (current_time.tv_usec - start_time.tv_usec) / 1000000.0;

        if (elapsed_time > response_time) {
          tcflush(fd, TCIFLUSH); // clear the buffer
          fprintf(stderr, "send_at_command: Timeout occurred\n");
          return -1; // Timeout occurred
        }
        usleep(10000); // small delay before retry (10ms)
        continue;      // retry read
      } else {
        perror("send_at_command: read failed");
        return -1;
      }
    }

    if (bytes_read == 0) {
      // End of file or no more data
      break;
    }

    total_bytes_read += bytes_read;
    if (strstr(response, "OK\r\n") != NULL) {
      break; // Stop reading when OK is received.
    }
  }

  response[total_bytes_read] = '\0'; // Null-terminate the string
  return 0;
}

void close_serial_port(int fd) { close(fd); }

void *process_device(void *arg) {
  int serial_fd;
  char *dev_path = (char *)arg;
  char response[MAX_BUFFER_SIZE];
  int at_command_count =
      sizeof(ATCS) / sizeof(ATCS[0]); // Calculate number of AT commands

  printf("Thread processing device: %s\n", dev_path);
  serial_fd = open_serial_port(dev_path);
  if (serial_fd == -1) {
    fprintf(stderr, "Error opening serial port: %s\n", strerror(errno));
    return NULL;
  }

  // Send AT commands
  for (int i = 0; i < at_command_count; i++) {
    char command[128]; // Ensure enough space for the command
    snprintf(command, sizeof(command) - 1, "%s\r",
             ATCS[i].command); // Append \r

    if (send_at_command(serial_fd, command, response, sizeof(response),
                        ATCS[i].response_time) == 0) {
      printf("Response to '%s': %s\n", ATCS[i].command, response);

      pthread_mutex_lock(&response_mutex);
      if (response_count < MAX_AT_RESPONSE) {
        strncpy(device_responses[response_count].device_path, dev_path,
                MAX_DEVICE_PATH - 1);
        device_responses[response_count].device_path[MAX_DEVICE_PATH - 1] =
            '\0'; // Ensure null termination

        strncpy(device_responses[response_count].response, response,
                MAX_BUFFER_SIZE - 1);
        device_responses[response_count].response[MAX_BUFFER_SIZE - 1] =
            '\0'; // Ensure null termination

        response_count++; // Increment response count

      } else {
        fprintf(stderr, "Response buffer is full!\n");
      }
      pthread_mutex_unlock(&response_mutex);

    } else {
      fprintf(stderr, "Error sending command '%s'\n", ATCS[i].command);
    }
  }

  close_serial_port(serial_fd);
  pthread_exit(NULL);
}

int find_tty_acm(int argc, char *argv[], int *get_count,
                 char dev_path[][MAX_DEVICE_PATH]) {
  if (argc != 4) {
    fprintf(stderr, "Usage: %s  \n", argv[0]); // Corrected Usage message
    return 1;
  }

  const char *target_vid = argv[1];
  const char *target_pid = argv[2];
  const char *target_bInterfaceNumber = argv[3];

  struct udev *udev = udev_new();
  if (!udev) {
    fprintf(stderr, "Failed to create udev object\n");
    return 1;
  }

  struct udev_enumerate *enumerate = udev_enumerate_new(udev);
  udev_enumerate_add_match_subsystem(enumerate, "tty");
  udev_enumerate_add_match_property(enumerate, "ID_VENDOR_ID", target_vid);
  udev_enumerate_add_match_property(enumerate, "ID_MODEL_ID", target_pid);
  udev_enumerate_scan_devices(enumerate);

  struct udev_list_entry *devices = udev_enumerate_get_list_entry(enumerate);
  struct udev_list_entry *entry;

  int i = 0;
  udev_list_entry_foreach(entry, devices) {
    const char *path = udev_list_entry_get_name(entry);
    struct udev_device *dev = udev_device_new_from_syspath(udev, path);
    if (!dev) {
      fprintf(stderr, "Error creating udev_device from syspath: %s\n", path);
      continue; // Skip to the next device
    }

    const char *devnode = udev_device_get_devnode(dev);
    const char *bInterface =
        udev_device_get_property_value(dev, "ID_USB_INTERFACE_NUM");

    if (devnode && bInterface &&
        strcmp(bInterface, target_bInterfaceNumber) == 0) {
      if (i < MAX_AT_RESPONSE) { // Check for overflow
        strncpy(dev_path[i], devnode, MAX_DEVICE_PATH - 1); // Use strncpy
        dev_path[i][MAX_DEVICE_PATH - 1] = '\0';            // Null-terminate
        printf("Found device: %s\n", devnode);
        i++;
        (*get_count)++;
      } else {
        fprintf(stderr, "Too many devices found.  Increase MAX_AT_RESPONSE.\n");
        break;
      }
    }
    udev_device_unref(dev);
  }

  udev_enumerate_unref(enumerate); // Free enumerate object
  udev_unref(udev);

  return 0;
}

void GetResponseData(char *input, char *output, size_t array_size,
                     int line_sopt) {
  char *line, *saveptr;
  int stop = 0;

  output[0] = '\0'; // Initialize output string

  line = strtok_r(input, "\n", &saveptr);
  while (line != NULL) {
    if (stop == line_sopt) {
      strncpy(output, line, array_size - 1); // Use strncpy for safety
      output[array_size - 1] = '\0';         // Ensure null termination
      return;
    }
    line = strtok_r(NULL, "\n", &saveptr);
    stop++;
  }
  output[0] = '\0'; // If line_sopt is out of range, return an empty string
}

int main(int argc, char *argv[]) {
  int device_count = 0;
  char dev_path[MAX_AT_RESPONSE]
               [MAX_DEVICE_PATH];     // Array to store device paths
  pthread_t threads[MAX_AT_RESPONSE]; // Array to store thread IDs
  int thread_creation_result;

  sleep(5); //waiting for systemctl...le910cx.service and Modemanager

  if (find_tty_acm(argc, argv, &device_count, dev_path) != 0) {
    fprintf(stderr, "find_tty_acm failed\n");
    exit(EXIT_FAILURE);
  }

  printf("Loop count: %d\n", device_count);
  if (device_count == 0) {
    printf("No devices found. Exiting.\n");
    exit(EXIT_SUCCESS);
  }

  // Create threads for each device found
  for (int i = 0; i < device_count; i++) {
    printf("Creating thread for device: %s\n", dev_path[i]);
    thread_creation_result =
        pthread_create(&threads[i], NULL, process_device, (void *)dev_path[i]);
    if (thread_creation_result != 0) {
      fprintf(stderr, "ERROR; return code from pthread_create() is %d\n",
              thread_creation_result);
      exit(EXIT_FAILURE);
    }
  }

  // Wait for all threads to complete
  for (int i = 0; i < device_count; i++) {
    pthread_join(threads[i], NULL);
  }

  exit(EXIT_SUCCESS);
}

compile

$ gcc enable_gnss.c -o enable_gnss -Wall -Wextra -pthread -ludev

$ ./enable_gnss 1bc7 1031 02

$ cat /etc/systemd/system/le910cx.service

[Unit]
Description=enGNSS_NMEA_LE910Cx
After=ModemManager.service
After=network.target

[Service]
ExecStart=/home/nvidia/gnss/enable_gnss 1bc7 1031 02
Type=oneshot
RemainAfterExit=yes
User=root
Group=root

[Install]
WantedBy=multi-user.target

reboot and check it

//$ sudo systemctl daemon-reload

reboot


$ sudo systemctl start le910cx.service


$ sudo systemctl status le910cx.service
● le910cx.service - enGNSS_NMEA_LE910Cx
     Loaded: loaded (/etc/systemd/system/le910cx.service; disabled; vendor pres>
     Active: active (exited) since Tue 2025-05-20 08:30:16 UTC; 8s ago
    Process: 2228 ExecStart=/home/nvidia/gnss/enable_gnss 1bc7 1031 02 (code=ex>
   Main PID: 2228 (code=exited, status=0/SUCCESS)
        CPU: 23ms

May 20 08:30:11 tegra-ubuntu systemd[1]: Starting enGNSS_NMEA_LE910Cx...
May 20 08:30:16 tegra-ubuntu enable_gnss[2228]: Found device: /dev/ttyUSB2
May 20 08:30:16 tegra-ubuntu enable_gnss[2228]: Loop count: 1
May 20 08:30:16 tegra-ubuntu enable_gnss[2228]: Creating thread for device: /de>
May 20 08:30:16 tegra-ubuntu enable_gnss[2228]: Thread processing device: /dev/>
May 20 08:30:16 tegra-ubuntu enable_gnss[2228]: Response to 'at$GPSP=1': at$GPS>
May 20 08:30:16 tegra-ubuntu enable_gnss[2228]: OK
May 20 08:30:16 tegra-ubuntu enable_gnss[2228]: Response to 'AT$GPSNMUN=1,1,1,1>
May 20 08:30:16 tegra-ubuntu enable_gnss[2228]: OK
May 20 08:30:16 tegra-ubuntu systemd[1]: Finished enGNSS_NMEA_LE910Cx.


開機啟動
$ sudo systemctl enable le910cx.service

ref:
1. ModemManager-filter

訂閱：文章 (Atom)

2025年7月1日 星期二