feat: 5G自动拨号、软件时钟同步、机器人端控制程序自启。
This commit is contained in:
78
scripts/boot/5g-dial.sh
Normal file
78
scripts/boot/5g-dial.sh
Normal file
@@ -0,0 +1,78 @@
|
|||||||
|
#!/usr/bin/env bash
|
||||||
|
set -euo pipefail
|
||||||
|
|
||||||
|
SCRIPT_DIR="$(cd "$(dirname "${BASH_SOURCE[0]}")" && pwd)"
|
||||||
|
# shellcheck disable=SC1091
|
||||||
|
source "${SCRIPT_DIR}/common.sh"
|
||||||
|
|
||||||
|
STEP="5g-dial"
|
||||||
|
|
||||||
|
wait_for_serial() {
|
||||||
|
local serial_port="$1"
|
||||||
|
local timeout_sec="$2"
|
||||||
|
local waited=0
|
||||||
|
|
||||||
|
while (( waited < timeout_sec )); do
|
||||||
|
if [[ -e "${serial_port}" ]]; then
|
||||||
|
blitz_log "${STEP}" "wait-serial" "success" "serial_port=${serial_port} waited_sec=${waited}" 0
|
||||||
|
return 0
|
||||||
|
fi
|
||||||
|
if (( waited == 0 || waited % 5 == 0 )); then
|
||||||
|
blitz_log "${STEP}" "wait-serial" "waiting" "serial_port=${serial_port} waited_sec=${waited}" 0
|
||||||
|
fi
|
||||||
|
sleep 1
|
||||||
|
waited=$(( waited + 1 ))
|
||||||
|
done
|
||||||
|
|
||||||
|
blitz_log "${STEP}" "wait-serial" "failure" "serial_port=${serial_port} timeout_sec=${timeout_sec}" 1
|
||||||
|
return 1
|
||||||
|
}
|
||||||
|
|
||||||
|
wait_for_route() {
|
||||||
|
local target_ip="$1"
|
||||||
|
local timeout_sec="$2"
|
||||||
|
local waited=0
|
||||||
|
local route_output
|
||||||
|
|
||||||
|
while (( waited < timeout_sec )); do
|
||||||
|
route_output="$(blitz_route_ready "${target_ip}" || true)"
|
||||||
|
if [[ -n "${route_output}" ]]; then
|
||||||
|
blitz_log "${STEP}" "route-check" "success" "target_ip=${target_ip} route=${route_output}" 0
|
||||||
|
return 0
|
||||||
|
fi
|
||||||
|
if (( waited == 0 || waited % 5 == 0 )); then
|
||||||
|
blitz_log "${STEP}" "route-check" "waiting" "target_ip=${target_ip} waited_sec=${waited}" 0
|
||||||
|
fi
|
||||||
|
sleep 1
|
||||||
|
waited=$(( waited + 1 ))
|
||||||
|
done
|
||||||
|
|
||||||
|
blitz_log "${STEP}" "route-check" "failure" "target_ip=${target_ip} timeout_sec=${timeout_sec}" 1
|
||||||
|
return 1
|
||||||
|
}
|
||||||
|
|
||||||
|
blitz_load_boot_env
|
||||||
|
blitz_require_root "${STEP}"
|
||||||
|
blitz_require_command ip "${STEP}"
|
||||||
|
blitz_require_command python3 "${STEP}"
|
||||||
|
blitz_require_file "${BLITZ_5G_DIAL_DIR}/rndis_dial.py" "${STEP}"
|
||||||
|
|
||||||
|
if [[ -z "${BLITZ_TIME_SERVER_IP}" ]]; then
|
||||||
|
blitz_log "${STEP}" "precheck" "failure" "BLITZ_TIME_SERVER_IP is empty and no fallback could be derived" 1
|
||||||
|
exit 1
|
||||||
|
fi
|
||||||
|
|
||||||
|
route_output="$(blitz_route_ready "${BLITZ_TIME_SERVER_IP}" || true)"
|
||||||
|
if [[ -n "${route_output}" ]]; then
|
||||||
|
blitz_log "${STEP}" "dial" "already_up" "target_ip=${BLITZ_TIME_SERVER_IP} route=${route_output}" 0
|
||||||
|
exit 0
|
||||||
|
fi
|
||||||
|
|
||||||
|
wait_for_serial "${BLITZ_5G_SERIAL_PORT}" "${BLITZ_5G_SERIAL_WAIT_SEC}"
|
||||||
|
|
||||||
|
pushd "${BLITZ_5G_DIAL_DIR}" >/dev/null
|
||||||
|
blitz_run "${STEP}" "dial" python3 rndis_dial.py --serial-port "${BLITZ_5G_SERIAL_PORT}"
|
||||||
|
popd >/dev/null
|
||||||
|
|
||||||
|
wait_for_route "${BLITZ_TIME_SERVER_IP}" "${BLITZ_5G_ROUTE_WAIT_SEC}"
|
||||||
|
blitz_log "${STEP}" "complete" "success" "5G dial completed and route is ready" 0
|
||||||
379
scripts/boot/README.md
Normal file
379
scripts/boot/README.md
Normal file
@@ -0,0 +1,379 @@
|
|||||||
|
# 机器人 B 端开机自启说明
|
||||||
|
|
||||||
|
这个目录是给机器人端做开机自启用的。
|
||||||
|
|
||||||
|
你看到这里多了不少脚本和 `systemd` 单元，不是为了让你手工一条条执行，而是为了把开机流程拆开管理：
|
||||||
|
|
||||||
|
1. 固定启动顺序
|
||||||
|
2. 某一步失败时可单独重试
|
||||||
|
3. 所有动作统一写到一个本地日志文件
|
||||||
|
4. 后面如果要把“固定延时 30 秒”换成“等待机器人原有自检完成”，只改最前面的闸门即可
|
||||||
|
|
||||||
|
所以平时真正需要人工执行的，通常只有这两步：
|
||||||
|
|
||||||
|
```bash
|
||||||
|
sudo bash scripts/boot/install-systemd.sh
|
||||||
|
sudo systemctl start blitz-robot.target
|
||||||
|
```
|
||||||
|
|
||||||
|
以后机器人重启时，就不需要你再手工执行这些脚本了。
|
||||||
|
|
||||||
|
## 启动顺序
|
||||||
|
|
||||||
|
当前开机链路如下：
|
||||||
|
|
||||||
|
1. `blitz-boot-gate.service`
|
||||||
|
2. `blitz-5g-dial.service`
|
||||||
|
3. `blitz-time-sync.service`
|
||||||
|
4. `blitz-ros-receiver.service`
|
||||||
|
5. `blitz-b-side-omnid.service`
|
||||||
|
|
||||||
|
对应业务顺序就是：
|
||||||
|
|
||||||
|
1. 先固定等待 30 秒，给机器人原有自检/自启程序让路
|
||||||
|
2. 运行 5G 自动拨号
|
||||||
|
3. 运行时钟同步
|
||||||
|
4. 启动 `start-ros-receiver.sh`
|
||||||
|
5. 启动 `start-b-side-omnid.sh`
|
||||||
|
|
||||||
|
## 日志文件
|
||||||
|
|
||||||
|
所有关键操作都会统一写到这个本地文件：
|
||||||
|
|
||||||
|
```text
|
||||||
|
/var/log/blitz-robot/startup.log
|
||||||
|
```
|
||||||
|
|
||||||
|
每一行日志格式如下：
|
||||||
|
|
||||||
|
```text
|
||||||
|
timestamp | step | action | result | details | exit_code
|
||||||
|
```
|
||||||
|
|
||||||
|
日志里会记录：
|
||||||
|
|
||||||
|
- 做了什么
|
||||||
|
- 实际执行了什么命令
|
||||||
|
- 前置检查是否通过
|
||||||
|
- 成功还是失败
|
||||||
|
- 失败原因
|
||||||
|
- 退出码
|
||||||
|
- 是否发生了重试
|
||||||
|
|
||||||
|
## 这些文件分别是干什么的
|
||||||
|
|
||||||
|
- `robot-boot.env`：开机自启默认配置
|
||||||
|
- `robot-boot.env.local`：本机覆盖配置，建议把你自己的配置写这里
|
||||||
|
- `common.sh`：公共环境加载和统一日志函数
|
||||||
|
- `boot-gate.sh`：启动闸门，当前逻辑是固定等待 30 秒
|
||||||
|
- `5g-dial.sh`：等待 5G 串口出现，执行 `rndis_dial.py`，并检查路由是否真的起来
|
||||||
|
- `time-sync.sh`：把 `chrony` 指向白名单服务器 IP 和端口，并执行一次同步
|
||||||
|
- `start-ros-receiver-service.sh`：开机版 ROS receiver 启动包装
|
||||||
|
- `wait-for-unix-socket.sh`：等待 ROS receiver 建好本地 unix socket
|
||||||
|
- `start-b-side-omnid-service.sh`：开机版 `b_side_omnid` 启动包装
|
||||||
|
- `install-systemd.sh`：把 `systemd` 单元安装到 `/etc/systemd/system`
|
||||||
|
- `systemd/*.service.in`、`systemd/*.target.in`：`systemd` 模板文件
|
||||||
|
|
||||||
|
## 前置条件
|
||||||
|
|
||||||
|
你前面说过，除了时钟同步以外，其他程序环境都应该已经配好了。按这个前提，这里只强调必须确认的前置条件。
|
||||||
|
|
||||||
|
### 1. 机器人侧必须已有的条件
|
||||||
|
|
||||||
|
默认认为下面这些已经具备：
|
||||||
|
|
||||||
|
- 系统是 Ubuntu，且使用 `systemd`
|
||||||
|
- `OmniSocketGo` 仓库已经放在机器人上
|
||||||
|
- `scripts/dev/start-ros-receiver.sh` 原本就能正常启动
|
||||||
|
- `scripts/dev/start-b-side-omnid.sh` 原本就能正常启动
|
||||||
|
- `bin/b_side_omnid` 已经提前编译好
|
||||||
|
- 5G 拨号脚本存在：`/home/nvidia/5g-test/5G/rndis_dial.py`
|
||||||
|
- 5G 串口设备是：`/dev/ttyUSB7`
|
||||||
|
|
||||||
|
注意：
|
||||||
|
|
||||||
|
- 开机模式下不会自动编译 `b_side_omnid`
|
||||||
|
- 如果 `bin/b_side_omnid` 不存在，服务会直接报错并写日志
|
||||||
|
|
||||||
|
### 2. 时钟同步需要的前置安装
|
||||||
|
|
||||||
|
时钟同步这一步依赖 `chrony`。
|
||||||
|
|
||||||
|
如果机器人侧没有安装，请先安装：
|
||||||
|
|
||||||
|
```bash
|
||||||
|
sudo apt update
|
||||||
|
sudo apt install -y chrony
|
||||||
|
```
|
||||||
|
|
||||||
|
安装后建议确认：
|
||||||
|
|
||||||
|
```bash
|
||||||
|
systemctl status chrony
|
||||||
|
chronyc tracking
|
||||||
|
```
|
||||||
|
|
||||||
|
### 3. 云服务器侧需要的前置条件
|
||||||
|
|
||||||
|
因为你的 5G 是白名单网络，所以时钟同步不能依赖公网域名或默认 NTP 池，必须只用你的白名单云服务器 IP。
|
||||||
|
|
||||||
|
云服务器侧需要满足：
|
||||||
|
|
||||||
|
- 服务器上运行 `chronyd`
|
||||||
|
- 安全组 / 防火墙放通你实际使用的 UDP 端口
|
||||||
|
- 机器人能访问这台服务器的 IP
|
||||||
|
|
||||||
|
如果云服务器还没有安装 `chrony`，可以参考：
|
||||||
|
|
||||||
|
```bash
|
||||||
|
sudo apt update
|
||||||
|
sudo apt install -y chrony
|
||||||
|
sudo systemctl enable chrony
|
||||||
|
sudo systemctl restart chrony
|
||||||
|
```
|
||||||
|
|
||||||
|
如果你不能使用标准的 `123/udp`，完全可以改成你自己的端口，例如 `10910/udp`。
|
||||||
|
|
||||||
|
例如云服务器 /etc/chrony/chrony.conf 里改成监听 10910：：
|
||||||
|
|
||||||
|
```conf
|
||||||
|
port 10910
|
||||||
|
allow 0/0
|
||||||
|
```
|
||||||
|
|
||||||
|
然后重启：
|
||||||
|
|
||||||
|
```bash
|
||||||
|
sudo systemctl restart chrony
|
||||||
|
```
|
||||||
|
|
||||||
|
机器人端则在 `robot-boot.env.local` 里配置：
|
||||||
|
|
||||||
|
```bash
|
||||||
|
BLITZ_TIME_SERVER_IP="你的云服务器IP"
|
||||||
|
BLITZ_TIME_SERVER_PORT="10910"
|
||||||
|
```
|
||||||
|
|
||||||
|
这样 `time-sync.sh` 会自动生成：
|
||||||
|
|
||||||
|
```conf
|
||||||
|
server 你的云服务器IP port 10910 iburst
|
||||||
|
```
|
||||||
|
|
||||||
|
注意：这里必须是你自己可控的 `chronyd` 服务端。公网标准 NTP 服务通常只监听 `123/udp`，不能要求它们改到 `10910`。
|
||||||
|
|
||||||
|
## 需要改哪些配置
|
||||||
|
|
||||||
|
不要直接改 `robot-boot.env`，更推荐新建：
|
||||||
|
|
||||||
|
```text
|
||||||
|
scripts/boot/robot-boot.env.local
|
||||||
|
```
|
||||||
|
|
||||||
|
常见要改的是这些：
|
||||||
|
|
||||||
|
```bash
|
||||||
|
BLITZ_BOOT_DELAY_SEC="30"
|
||||||
|
BLITZ_LOG_FILE="/var/log/blitz-robot/startup.log"
|
||||||
|
|
||||||
|
BLITZ_5G_DIAL_DIR="/home/nvidia/5g-test/5G"
|
||||||
|
BLITZ_5G_SERIAL_PORT="/dev/ttyUSB7"
|
||||||
|
|
||||||
|
BLITZ_TIME_SERVER_IP="你的白名单云服务器IP"
|
||||||
|
BLITZ_TIME_SERVER_PORT="10910"
|
||||||
|
|
||||||
|
BLITZ_ROS_USER="nvidia"
|
||||||
|
```
|
||||||
|
|
||||||
|
如果 `BLITZ_TIME_SERVER_IP` 留空，脚本会自动回退到 `ROBOT_SIDE_OMNISOCKET_SERVER_ADDR` 的 IP 部分。
|
||||||
|
|
||||||
|
## 如何安装和使用
|
||||||
|
|
||||||
|
下面假设你当前目录就在 `OmniSocketGo` 仓库根目录。
|
||||||
|
|
||||||
|
### 第一步：准备本机配置
|
||||||
|
|
||||||
|
建议先创建：
|
||||||
|
|
||||||
|
```bash
|
||||||
|
cp scripts/boot/robot-boot.env scripts/boot/robot-boot.env.local
|
||||||
|
```
|
||||||
|
|
||||||
|
然后编辑：
|
||||||
|
|
||||||
|
```bash
|
||||||
|
vim scripts/boot/robot-boot.env.local
|
||||||
|
```
|
||||||
|
|
||||||
|
至少确认这几个值是对的：
|
||||||
|
|
||||||
|
- `BLITZ_5G_DIAL_DIR`
|
||||||
|
- `BLITZ_5G_SERIAL_PORT`
|
||||||
|
- `BLITZ_TIME_SERVER_IP`
|
||||||
|
- `BLITZ_TIME_SERVER_PORT`
|
||||||
|
- `BLITZ_ROS_USER`
|
||||||
|
|
||||||
|
### 第二步：安装 systemd 单元
|
||||||
|
|
||||||
|
执行：
|
||||||
|
|
||||||
|
```bash
|
||||||
|
sudo bash scripts/boot/install-systemd.sh
|
||||||
|
```
|
||||||
|
|
||||||
|
这个安装脚本会做这些事情：
|
||||||
|
|
||||||
|
1. 创建日志目录和日志文件
|
||||||
|
2. 渲染 `systemd` 模板
|
||||||
|
3. 把 unit 文件复制到 `/etc/systemd/system`
|
||||||
|
4. 执行 `systemctl daemon-reload`
|
||||||
|
5. 执行 `systemctl enable blitz-robot.target`
|
||||||
|
|
||||||
|
### 第三步：立刻启动一次
|
||||||
|
|
||||||
|
执行：
|
||||||
|
|
||||||
|
```bash
|
||||||
|
sudo systemctl start blitz-robot.target
|
||||||
|
```
|
||||||
|
|
||||||
|
### 第四步：以后重启自动生效
|
||||||
|
|
||||||
|
因为安装脚本已经做了 `enable`，所以后续机器人重启时会自动拉起，不需要你再手工执行。
|
||||||
|
|
||||||
|
如果想手工确认，也可以执行：
|
||||||
|
|
||||||
|
```bash
|
||||||
|
sudo systemctl enable blitz-robot.target
|
||||||
|
```
|
||||||
|
|
||||||
|
## 如何查看是否正常
|
||||||
|
|
||||||
|
### 看总日志文件
|
||||||
|
|
||||||
|
最直接：
|
||||||
|
|
||||||
|
```bash
|
||||||
|
tail -f /var/log/blitz-robot/startup.log
|
||||||
|
```
|
||||||
|
|
||||||
|
### 看各个服务状态
|
||||||
|
|
||||||
|
```bash
|
||||||
|
systemctl status blitz-robot.target
|
||||||
|
systemctl status blitz-boot-gate.service
|
||||||
|
systemctl status blitz-5g-dial.service
|
||||||
|
systemctl status blitz-time-sync.service
|
||||||
|
systemctl status blitz-ros-receiver.service
|
||||||
|
systemctl status blitz-b-side-omnid.service
|
||||||
|
```
|
||||||
|
|
||||||
|
### 看 journal
|
||||||
|
|
||||||
|
```bash
|
||||||
|
journalctl -u blitz-robot.target -u blitz-boot-gate.service -u blitz-5g-dial.service \
|
||||||
|
-u blitz-time-sync.service -u blitz-ros-receiver.service -u blitz-b-side-omnid.service -f
|
||||||
|
```
|
||||||
|
|
||||||
|
## 当前时钟同步会做什么
|
||||||
|
|
||||||
|
`time-sync.sh` 当前逻辑是：
|
||||||
|
|
||||||
|
1. 读取 `BLITZ_TIME_SERVER_IP`
|
||||||
|
2. 读取 `BLITZ_TIME_SERVER_PORT`
|
||||||
|
3. 修改 `/etc/chrony/chrony.conf`
|
||||||
|
4. 注释掉原有的 `pool` 和 `server` 项
|
||||||
|
5. 保留一个备份文件：`/etc/chrony/chrony.conf.blitz-bak`
|
||||||
|
6. 写入：
|
||||||
|
|
||||||
|
```text
|
||||||
|
/etc/chrony/sources.d/blitz-robot.sources
|
||||||
|
```
|
||||||
|
|
||||||
|
7. 生成类似下面这一行：
|
||||||
|
|
||||||
|
```conf
|
||||||
|
server 你的云服务器IP port 10910 iburst
|
||||||
|
```
|
||||||
|
|
||||||
|
8. 重启 `chrony`
|
||||||
|
9. 执行 `chronyc burst`
|
||||||
|
10. 执行 `chronyc waitsync`
|
||||||
|
|
||||||
|
注意：
|
||||||
|
|
||||||
|
- 如果同步超时，会记日志为 `soft_fail`
|
||||||
|
- 但不会阻塞后面的 ROS 和 `b_side_omnid` 启动
|
||||||
|
|
||||||
|
## 常见问题
|
||||||
|
|
||||||
|
### 1. 为什么会突然多出这么多脚本？
|
||||||
|
|
||||||
|
因为把开机流程拆成了多个稳定的小步骤：
|
||||||
|
|
||||||
|
- 更容易排查哪一步失败
|
||||||
|
- 更容易让 `systemd` 自动重启
|
||||||
|
- 更容易记录完整日志
|
||||||
|
- 后续更容易替换“30 秒延时”为真正的机器人 ready 条件
|
||||||
|
|
||||||
|
你平时不需要手工逐个执行这些脚本。
|
||||||
|
|
||||||
|
### 2. 我是不是要手工跑 `5g-dial.sh`、`time-sync.sh`、`start-ros-receiver-service.sh`？
|
||||||
|
|
||||||
|
正常情况下不用。
|
||||||
|
|
||||||
|
你只需要：
|
||||||
|
|
||||||
|
```bash
|
||||||
|
sudo bash scripts/boot/install-systemd.sh
|
||||||
|
sudo systemctl start blitz-robot.target
|
||||||
|
```
|
||||||
|
|
||||||
|
### 3. 如果时钟同步失败怎么办？
|
||||||
|
|
||||||
|
先看：
|
||||||
|
|
||||||
|
```bash
|
||||||
|
tail -f /var/log/blitz-robot/startup.log
|
||||||
|
systemctl status blitz-time-sync.service
|
||||||
|
chronyc sources -v
|
||||||
|
chronyc tracking
|
||||||
|
```
|
||||||
|
|
||||||
|
优先检查：
|
||||||
|
|
||||||
|
- `BLITZ_TIME_SERVER_IP` 是否填对
|
||||||
|
- `BLITZ_TIME_SERVER_PORT` 是否填对
|
||||||
|
- 云服务器是否真的跑了 `chronyd`
|
||||||
|
- 云服务器防火墙 / 安全组是否放通你配置的 UDP 端口，例如 `10910`
|
||||||
|
- 5G 白名单是否确实允许访问这个服务器 IP
|
||||||
|
|
||||||
|
### 4. 如果 ROS receiver 没起来怎么办？
|
||||||
|
|
||||||
|
先看：
|
||||||
|
|
||||||
|
```bash
|
||||||
|
systemctl status blitz-ros-receiver.service
|
||||||
|
tail -f /var/log/blitz-robot/startup.log
|
||||||
|
```
|
||||||
|
|
||||||
|
再检查：
|
||||||
|
|
||||||
|
- `/opt/ros/${ROS_DISTRO}/setup.bash` 是否存在
|
||||||
|
- `${ROS_CONTROL_PY_DIR}/install/setup.bash` 是否存在
|
||||||
|
- `ROBOT_RECEIVER_LOCAL_SOCKET_PATH` 对应的 socket 是否出现
|
||||||
|
|
||||||
|
### 5. 如果 b_side_omnid 没起来怎么办？
|
||||||
|
|
||||||
|
先看：
|
||||||
|
|
||||||
|
```bash
|
||||||
|
systemctl status blitz-b-side-omnid.service
|
||||||
|
tail -f /var/log/blitz-robot/startup.log
|
||||||
|
```
|
||||||
|
|
||||||
|
再检查：
|
||||||
|
|
||||||
|
- `bin/b_side_omnid` 是否已经提前编译好
|
||||||
|
- 摄像头设备是否存在
|
||||||
|
- `robot-remote.env` / `robot-boot.env.local` 里的地址配置是否正确
|
||||||
15
scripts/boot/boot-gate.sh
Normal file
15
scripts/boot/boot-gate.sh
Normal file
@@ -0,0 +1,15 @@
|
|||||||
|
#!/usr/bin/env bash
|
||||||
|
set -euo pipefail
|
||||||
|
|
||||||
|
SCRIPT_DIR="$(cd "$(dirname "${BASH_SOURCE[0]}")" && pwd)"
|
||||||
|
# shellcheck disable=SC1091
|
||||||
|
source "${SCRIPT_DIR}/common.sh"
|
||||||
|
|
||||||
|
STEP="boot-gate"
|
||||||
|
|
||||||
|
blitz_load_boot_env
|
||||||
|
|
||||||
|
blitz_log "${STEP}" "start" "start" "delay_sec=${BLITZ_BOOT_DELAY_SEC}" 0
|
||||||
|
blitz_log "${STEP}" "delay" "start" "sleep ${BLITZ_BOOT_DELAY_SEC}s before starting Blitz services" 0
|
||||||
|
sleep "${BLITZ_BOOT_DELAY_SEC}"
|
||||||
|
blitz_log "${STEP}" "delay" "success" "boot gate released after ${BLITZ_BOOT_DELAY_SEC}s" 0
|
||||||
188
scripts/boot/common.sh
Normal file
188
scripts/boot/common.sh
Normal file
@@ -0,0 +1,188 @@
|
|||||||
|
#!/usr/bin/env bash
|
||||||
|
set -euo pipefail
|
||||||
|
|
||||||
|
BOOT_SCRIPT_DIR="$(cd "$(dirname "${BASH_SOURCE[0]}")" && pwd)"
|
||||||
|
DEV_SCRIPT_DIR="$(cd "${BOOT_SCRIPT_DIR}/../dev" && pwd)"
|
||||||
|
|
||||||
|
source_with_nounset_off() {
|
||||||
|
set +u
|
||||||
|
# shellcheck disable=SC1090
|
||||||
|
source "$1"
|
||||||
|
set -u
|
||||||
|
}
|
||||||
|
|
||||||
|
blitz_host_from_addr() {
|
||||||
|
local value="${1:-}"
|
||||||
|
|
||||||
|
if [[ -z "${value}" ]]; then
|
||||||
|
return 1
|
||||||
|
fi
|
||||||
|
if [[ "${value}" == \[*\]:* ]]; then
|
||||||
|
value="${value#\[}"
|
||||||
|
printf '%s\n' "${value%%]:*}"
|
||||||
|
return 0
|
||||||
|
fi
|
||||||
|
printf '%s\n' "${value%%:*}"
|
||||||
|
}
|
||||||
|
|
||||||
|
blitz_load_boot_env() {
|
||||||
|
local env_file
|
||||||
|
local default_time_server
|
||||||
|
|
||||||
|
if [[ "${BLITZ_BOOT_ENV_LOADED:-0}" == "1" ]]; then
|
||||||
|
return 0
|
||||||
|
fi
|
||||||
|
|
||||||
|
# shellcheck disable=SC1091
|
||||||
|
source "${DEV_SCRIPT_DIR}/load-env.sh"
|
||||||
|
|
||||||
|
for env_file in \
|
||||||
|
"${BOOT_SCRIPT_DIR}/robot-boot.env" \
|
||||||
|
"${BOOT_SCRIPT_DIR}/robot-boot.env.local"
|
||||||
|
do
|
||||||
|
if [[ -f "${env_file}" ]]; then
|
||||||
|
set -a
|
||||||
|
# shellcheck disable=SC1090
|
||||||
|
source "${env_file}"
|
||||||
|
set +a
|
||||||
|
fi
|
||||||
|
done
|
||||||
|
|
||||||
|
default_time_server="$(blitz_host_from_addr "${ROBOT_SIDE_OMNISOCKET_SERVER_ADDR:-}" || true)"
|
||||||
|
|
||||||
|
export BLITZ_BOOT_DELAY_SEC="${BLITZ_BOOT_DELAY_SEC:-30}"
|
||||||
|
export BLITZ_LOG_FILE="${BLITZ_LOG_FILE:-/var/log/blitz-robot/startup.log}"
|
||||||
|
export BLITZ_5G_DIAL_DIR="${BLITZ_5G_DIAL_DIR:-/home/nvidia/5g-test/5G}"
|
||||||
|
export BLITZ_5G_SERIAL_PORT="${BLITZ_5G_SERIAL_PORT:-/dev/ttyUSB7}"
|
||||||
|
export BLITZ_5G_SERIAL_WAIT_SEC="${BLITZ_5G_SERIAL_WAIT_SEC:-60}"
|
||||||
|
export BLITZ_5G_ROUTE_WAIT_SEC="${BLITZ_5G_ROUTE_WAIT_SEC:-30}"
|
||||||
|
export BLITZ_TIME_SERVER_IP="${BLITZ_TIME_SERVER_IP:-${default_time_server}}"
|
||||||
|
export BLITZ_TIME_SERVER_PORT="${BLITZ_TIME_SERVER_PORT:-123}"
|
||||||
|
export BLITZ_TIME_SYNC_WAIT_SEC="${BLITZ_TIME_SYNC_WAIT_SEC:-60}"
|
||||||
|
export BLITZ_TIME_SYNC_MAX_OFFSET_SEC="${BLITZ_TIME_SYNC_MAX_OFFSET_SEC:-0.002}"
|
||||||
|
export BLITZ_TIME_SYNC_INTERVAL_SEC="${BLITZ_TIME_SYNC_INTERVAL_SEC:-1}"
|
||||||
|
export BLITZ_ROS_USER="${BLITZ_ROS_USER:-nvidia}"
|
||||||
|
export BLITZ_ROS_SOCKET_WAIT_SEC="${BLITZ_ROS_SOCKET_WAIT_SEC:-20}"
|
||||||
|
export BLITZ_BOOT_ENV_LOADED="1"
|
||||||
|
}
|
||||||
|
|
||||||
|
blitz_timestamp() {
|
||||||
|
date '+%Y-%m-%d %H:%M:%S%z'
|
||||||
|
}
|
||||||
|
|
||||||
|
blitz_sanitize_detail() {
|
||||||
|
local detail="${1:-}"
|
||||||
|
|
||||||
|
detail="${detail//$'\n'/ ; }"
|
||||||
|
detail="${detail//$'\r'/ }"
|
||||||
|
printf '%s' "${detail}"
|
||||||
|
}
|
||||||
|
|
||||||
|
blitz_log() {
|
||||||
|
local step="${1:-unknown-step}"
|
||||||
|
local action="${2:-unknown-action}"
|
||||||
|
local result="${3:-info}"
|
||||||
|
local details="${4:-}"
|
||||||
|
local exit_code="${5:-0}"
|
||||||
|
|
||||||
|
printf '%s | %s | %s | %s | %s | %s\n' \
|
||||||
|
"$(blitz_timestamp)" \
|
||||||
|
"${step}" \
|
||||||
|
"${action}" \
|
||||||
|
"${result}" \
|
||||||
|
"$(blitz_sanitize_detail "${details}")" \
|
||||||
|
"${exit_code}"
|
||||||
|
}
|
||||||
|
|
||||||
|
blitz_join_cmd() {
|
||||||
|
local cmd=()
|
||||||
|
local arg
|
||||||
|
|
||||||
|
for arg in "$@"; do
|
||||||
|
cmd+=("$(printf '%q' "${arg}")")
|
||||||
|
done
|
||||||
|
printf '%s' "${cmd[*]}"
|
||||||
|
}
|
||||||
|
|
||||||
|
blitz_require_command() {
|
||||||
|
local command_name="$1"
|
||||||
|
local step="${2:-precheck}"
|
||||||
|
|
||||||
|
if command -v "${command_name}" >/dev/null 2>&1; then
|
||||||
|
blitz_log "${step}" "require-command" "success" "command=${command_name}" 0
|
||||||
|
return 0
|
||||||
|
fi
|
||||||
|
|
||||||
|
blitz_log "${step}" "require-command" "failure" "missing command: ${command_name}" 127
|
||||||
|
return 127
|
||||||
|
}
|
||||||
|
|
||||||
|
blitz_require_file() {
|
||||||
|
local path="$1"
|
||||||
|
local step="${2:-precheck}"
|
||||||
|
|
||||||
|
if [[ -f "${path}" ]]; then
|
||||||
|
blitz_log "${step}" "require-file" "success" "path=${path}" 0
|
||||||
|
return 0
|
||||||
|
fi
|
||||||
|
|
||||||
|
blitz_log "${step}" "require-file" "failure" "missing file: ${path}" 1
|
||||||
|
return 1
|
||||||
|
}
|
||||||
|
|
||||||
|
blitz_require_executable() {
|
||||||
|
local path="$1"
|
||||||
|
local step="${2:-precheck}"
|
||||||
|
|
||||||
|
if [[ -x "${path}" ]]; then
|
||||||
|
blitz_log "${step}" "require-executable" "success" "path=${path}" 0
|
||||||
|
return 0
|
||||||
|
fi
|
||||||
|
|
||||||
|
blitz_log "${step}" "require-executable" "failure" "missing executable: ${path}" 1
|
||||||
|
return 1
|
||||||
|
}
|
||||||
|
|
||||||
|
blitz_require_root() {
|
||||||
|
local step="${1:-precheck}"
|
||||||
|
|
||||||
|
if [[ "${EUID}" -eq 0 ]]; then
|
||||||
|
blitz_log "${step}" "require-root" "success" "uid=${EUID}" 0
|
||||||
|
return 0
|
||||||
|
fi
|
||||||
|
|
||||||
|
blitz_log "${step}" "require-root" "failure" "root privileges are required" 1
|
||||||
|
return 1
|
||||||
|
}
|
||||||
|
|
||||||
|
blitz_run() {
|
||||||
|
local step="$1"
|
||||||
|
local action="$2"
|
||||||
|
shift 2
|
||||||
|
|
||||||
|
blitz_log "${step}" "${action}" "start" "$(blitz_join_cmd "$@")" 0
|
||||||
|
if "$@"; then
|
||||||
|
blitz_log "${step}" "${action}" "success" "$(blitz_join_cmd "$@")" 0
|
||||||
|
return 0
|
||||||
|
fi
|
||||||
|
|
||||||
|
local rc=$?
|
||||||
|
blitz_log "${step}" "${action}" "failure" "$(blitz_join_cmd "$@")" "${rc}"
|
||||||
|
return "${rc}"
|
||||||
|
}
|
||||||
|
|
||||||
|
blitz_route_ready() {
|
||||||
|
local target_ip="$1"
|
||||||
|
local route_output
|
||||||
|
|
||||||
|
route_output="$(ip route get "${target_ip}" 2>&1 || true)"
|
||||||
|
if [[ -z "${route_output}" ]]; then
|
||||||
|
return 1
|
||||||
|
fi
|
||||||
|
if [[ "${route_output}" == *"unreachable"* || "${route_output}" == *"prohibit"* ]]; then
|
||||||
|
return 1
|
||||||
|
fi
|
||||||
|
|
||||||
|
printf '%s\n' "${route_output}"
|
||||||
|
return 0
|
||||||
|
}
|
||||||
53
scripts/boot/install-systemd.sh
Normal file
53
scripts/boot/install-systemd.sh
Normal file
@@ -0,0 +1,53 @@
|
|||||||
|
#!/usr/bin/env bash
|
||||||
|
set -euo pipefail
|
||||||
|
|
||||||
|
SCRIPT_DIR="$(cd "$(dirname "${BASH_SOURCE[0]}")" && pwd)"
|
||||||
|
# shellcheck disable=SC1091
|
||||||
|
source "${SCRIPT_DIR}/common.sh"
|
||||||
|
|
||||||
|
SYSTEMD_TEMPLATE_DIR="${SCRIPT_DIR}/systemd"
|
||||||
|
SYSTEMD_DEST_DIR="/etc/systemd/system"
|
||||||
|
|
||||||
|
render_template() {
|
||||||
|
local template_path="$1"
|
||||||
|
local output_path="$2"
|
||||||
|
|
||||||
|
sed \
|
||||||
|
-e "s|@OMNISOCKETGO_ROOT@|${OMNISOCKETGO_ROOT}|g" \
|
||||||
|
-e "s|@BLITZ_LOG_FILE@|${BLITZ_LOG_FILE}|g" \
|
||||||
|
-e "s|@BLITZ_ROS_USER@|${BLITZ_ROS_USER}|g" \
|
||||||
|
"${template_path}" > "${output_path}"
|
||||||
|
}
|
||||||
|
|
||||||
|
install_unit() {
|
||||||
|
local template_name="$1"
|
||||||
|
local temp_output
|
||||||
|
|
||||||
|
temp_output="$(mktemp)"
|
||||||
|
render_template "${SYSTEMD_TEMPLATE_DIR}/${template_name}" "${temp_output}"
|
||||||
|
install -m 0644 "${temp_output}" "${SYSTEMD_DEST_DIR}/${template_name%.in}"
|
||||||
|
rm -f "${temp_output}"
|
||||||
|
blitz_log "install" "install-unit" "success" "unit=${SYSTEMD_DEST_DIR}/${template_name%.in}" 0
|
||||||
|
}
|
||||||
|
|
||||||
|
blitz_load_boot_env
|
||||||
|
blitz_require_root "install"
|
||||||
|
blitz_require_command install "install"
|
||||||
|
blitz_require_command systemctl "install"
|
||||||
|
|
||||||
|
mkdir -p "${SYSTEMD_DEST_DIR}"
|
||||||
|
install -d -m 0755 "$(dirname "${BLITZ_LOG_FILE}")"
|
||||||
|
touch "${BLITZ_LOG_FILE}"
|
||||||
|
chmod 0644 "${BLITZ_LOG_FILE}"
|
||||||
|
blitz_log "install" "prepare-log-file" "success" "log_file=${BLITZ_LOG_FILE}" 0
|
||||||
|
|
||||||
|
install_unit "blitz-boot-gate.service.in"
|
||||||
|
install_unit "blitz-5g-dial.service.in"
|
||||||
|
install_unit "blitz-time-sync.service.in"
|
||||||
|
install_unit "blitz-ros-receiver.service.in"
|
||||||
|
install_unit "blitz-b-side-omnid.service.in"
|
||||||
|
install_unit "blitz-robot.target.in"
|
||||||
|
|
||||||
|
blitz_run "install" "daemon-reload" systemctl daemon-reload
|
||||||
|
blitz_run "install" "enable-target" systemctl enable blitz-robot.target
|
||||||
|
blitz_log "install" "complete" "success" "run systemctl start blitz-robot.target to launch immediately" 0
|
||||||
25
scripts/boot/robot-boot.env
Normal file
25
scripts/boot/robot-boot.env
Normal file
@@ -0,0 +1,25 @@
|
|||||||
|
# Boot-time settings for the robot-side autostart chain.
|
||||||
|
# Override machine-specific values in robot-boot.env.local.
|
||||||
|
|
||||||
|
BLITZ_BOOT_DELAY_SEC="30"
|
||||||
|
BLITZ_LOG_FILE="/var/log/blitz-robot/startup.log"
|
||||||
|
|
||||||
|
BLITZ_5G_DIAL_DIR="/home/nvidia/5g-test/5G"
|
||||||
|
BLITZ_5G_SERIAL_PORT="/dev/ttyUSB7"
|
||||||
|
# 最多等 60 秒让 5G 模块对应的串口设备出现，比如 /dev/ttyUSB7
|
||||||
|
BLITZ_5G_SERIAL_WAIT_SEC="60"
|
||||||
|
# 拨号命令执行完以后，最多再等 30 秒，检查到你目标服务器 IP 的路由真的起来
|
||||||
|
BLITZ_5G_ROUTE_WAIT_SEC="30"
|
||||||
|
|
||||||
|
# Leave empty to fall back to the host part of ROBOT_SIDE_OMNISOCKET_SERVER_ADDR.
|
||||||
|
BLITZ_TIME_SERVER_IP="81.70.156.140"
|
||||||
|
BLITZ_TIME_SERVER_PORT="10910"
|
||||||
|
BLITZ_TIME_SYNC_WAIT_SEC="30"
|
||||||
|
BLITZ_TIME_SYNC_MAX_OFFSET_SEC="0.002"
|
||||||
|
BLITZ_TIME_SYNC_INTERVAL_SEC="1"
|
||||||
|
|
||||||
|
BLITZ_ROS_USER="nvidia"
|
||||||
|
BLITZ_ROS_SOCKET_WAIT_SEC="20"
|
||||||
|
|
||||||
|
# Boot units run b_side_omnid as root directly, so nested sudo must stay off.
|
||||||
|
B_SIDE_OMNID_USE_SUDO="0"
|
||||||
18
scripts/boot/start-b-side-omnid-service.sh
Normal file
18
scripts/boot/start-b-side-omnid-service.sh
Normal file
@@ -0,0 +1,18 @@
|
|||||||
|
#!/usr/bin/env bash
|
||||||
|
set -euo pipefail
|
||||||
|
|
||||||
|
SCRIPT_DIR="$(cd "$(dirname "${BASH_SOURCE[0]}")" && pwd)"
|
||||||
|
# shellcheck disable=SC1091
|
||||||
|
source "${SCRIPT_DIR}/common.sh"
|
||||||
|
|
||||||
|
STEP="b-side-omnid"
|
||||||
|
|
||||||
|
blitz_load_boot_env
|
||||||
|
|
||||||
|
blitz_require_executable "${OMNISOCKETGO_ROOT}/bin/b_side_omnid" "${STEP}"
|
||||||
|
|
||||||
|
export OMNI_BOOT_MODE="1"
|
||||||
|
export B_SIDE_OMNID_USE_SUDO="0"
|
||||||
|
|
||||||
|
blitz_log "${STEP}" "start" "start" "exec bash ${OMNISOCKETGO_ROOT}/scripts/dev/start-b-side-omnid.sh" 0
|
||||||
|
exec bash "${OMNISOCKETGO_ROOT}/scripts/dev/start-b-side-omnid.sh"
|
||||||
17
scripts/boot/start-ros-receiver-service.sh
Normal file
17
scripts/boot/start-ros-receiver-service.sh
Normal file
@@ -0,0 +1,17 @@
|
|||||||
|
#!/usr/bin/env bash
|
||||||
|
set -euo pipefail
|
||||||
|
|
||||||
|
SCRIPT_DIR="$(cd "$(dirname "${BASH_SOURCE[0]}")" && pwd)"
|
||||||
|
# shellcheck disable=SC1091
|
||||||
|
source "${SCRIPT_DIR}/common.sh"
|
||||||
|
|
||||||
|
STEP="ros-receiver"
|
||||||
|
|
||||||
|
blitz_load_boot_env
|
||||||
|
|
||||||
|
blitz_require_file "/opt/ros/${ROS_DISTRO}/setup.bash" "${STEP}"
|
||||||
|
blitz_require_file "${ROS_CONTROL_PY_DIR}/install/setup.bash" "${STEP}"
|
||||||
|
|
||||||
|
export OMNI_BOOT_MODE="1"
|
||||||
|
blitz_log "${STEP}" "start" "start" "exec bash ${OMNISOCKETGO_ROOT}/scripts/dev/start-ros-receiver.sh" 0
|
||||||
|
exec bash "${OMNISOCKETGO_ROOT}/scripts/dev/start-ros-receiver.sh"
|
||||||
14
scripts/boot/systemd/blitz-5g-dial.service.in
Normal file
14
scripts/boot/systemd/blitz-5g-dial.service.in
Normal file
@@ -0,0 +1,14 @@
|
|||||||
|
[Unit]
|
||||||
|
Description=Blitz robot 5G dial
|
||||||
|
After=blitz-boot-gate.service
|
||||||
|
Requires=blitz-boot-gate.service
|
||||||
|
|
||||||
|
[Service]
|
||||||
|
Type=oneshot
|
||||||
|
RemainAfterExit=yes
|
||||||
|
ExecStart=/bin/bash @OMNISOCKETGO_ROOT@/scripts/boot/5g-dial.sh
|
||||||
|
StandardOutput=append:@BLITZ_LOG_FILE@
|
||||||
|
StandardError=append:@BLITZ_LOG_FILE@
|
||||||
|
|
||||||
|
[Install]
|
||||||
|
WantedBy=blitz-robot.target
|
||||||
15
scripts/boot/systemd/blitz-b-side-omnid.service.in
Normal file
15
scripts/boot/systemd/blitz-b-side-omnid.service.in
Normal file
@@ -0,0 +1,15 @@
|
|||||||
|
[Unit]
|
||||||
|
Description=Blitz robot b-side omnid
|
||||||
|
After=blitz-time-sync.service blitz-ros-receiver.service
|
||||||
|
Requires=blitz-time-sync.service blitz-ros-receiver.service
|
||||||
|
|
||||||
|
[Service]
|
||||||
|
Type=simple
|
||||||
|
ExecStart=/bin/bash @OMNISOCKETGO_ROOT@/scripts/boot/start-b-side-omnid-service.sh
|
||||||
|
Restart=always
|
||||||
|
RestartSec=2
|
||||||
|
StandardOutput=append:@BLITZ_LOG_FILE@
|
||||||
|
StandardError=append:@BLITZ_LOG_FILE@
|
||||||
|
|
||||||
|
[Install]
|
||||||
|
WantedBy=blitz-robot.target
|
||||||
14
scripts/boot/systemd/blitz-boot-gate.service.in
Normal file
14
scripts/boot/systemd/blitz-boot-gate.service.in
Normal file
@@ -0,0 +1,14 @@
|
|||||||
|
[Unit]
|
||||||
|
Description=Blitz robot boot gate
|
||||||
|
After=multi-user.target network-online.target
|
||||||
|
Wants=network-online.target
|
||||||
|
|
||||||
|
[Service]
|
||||||
|
Type=oneshot
|
||||||
|
RemainAfterExit=yes
|
||||||
|
ExecStart=/bin/bash @OMNISOCKETGO_ROOT@/scripts/boot/boot-gate.sh
|
||||||
|
StandardOutput=append:@BLITZ_LOG_FILE@
|
||||||
|
StandardError=append:@BLITZ_LOG_FILE@
|
||||||
|
|
||||||
|
[Install]
|
||||||
|
WantedBy=blitz-robot.target
|
||||||
11
scripts/boot/systemd/blitz-robot.target.in
Normal file
11
scripts/boot/systemd/blitz-robot.target.in
Normal file
@@ -0,0 +1,11 @@
|
|||||||
|
[Unit]
|
||||||
|
Description=Blitz robot boot chain
|
||||||
|
Wants=blitz-boot-gate.service
|
||||||
|
Wants=blitz-5g-dial.service
|
||||||
|
Wants=blitz-time-sync.service
|
||||||
|
Wants=blitz-ros-receiver.service
|
||||||
|
Wants=blitz-b-side-omnid.service
|
||||||
|
After=multi-user.target
|
||||||
|
|
||||||
|
[Install]
|
||||||
|
WantedBy=multi-user.target
|
||||||
17
scripts/boot/systemd/blitz-ros-receiver.service.in
Normal file
17
scripts/boot/systemd/blitz-ros-receiver.service.in
Normal file
@@ -0,0 +1,17 @@
|
|||||||
|
[Unit]
|
||||||
|
Description=Blitz robot ROS receiver
|
||||||
|
After=blitz-time-sync.service
|
||||||
|
Requires=blitz-time-sync.service
|
||||||
|
|
||||||
|
[Service]
|
||||||
|
Type=simple
|
||||||
|
User=@BLITZ_ROS_USER@
|
||||||
|
ExecStart=/bin/bash @OMNISOCKETGO_ROOT@/scripts/boot/start-ros-receiver-service.sh
|
||||||
|
ExecStartPost=/bin/bash @OMNISOCKETGO_ROOT@/scripts/boot/wait-for-unix-socket.sh --step ros-receiver
|
||||||
|
Restart=always
|
||||||
|
RestartSec=2
|
||||||
|
StandardOutput=append:@BLITZ_LOG_FILE@
|
||||||
|
StandardError=append:@BLITZ_LOG_FILE@
|
||||||
|
|
||||||
|
[Install]
|
||||||
|
WantedBy=blitz-robot.target
|
||||||
14
scripts/boot/systemd/blitz-time-sync.service.in
Normal file
14
scripts/boot/systemd/blitz-time-sync.service.in
Normal file
@@ -0,0 +1,14 @@
|
|||||||
|
[Unit]
|
||||||
|
Description=Blitz robot private chrony sync
|
||||||
|
After=blitz-5g-dial.service
|
||||||
|
Requires=blitz-5g-dial.service
|
||||||
|
|
||||||
|
[Service]
|
||||||
|
Type=oneshot
|
||||||
|
RemainAfterExit=yes
|
||||||
|
ExecStart=/bin/bash @OMNISOCKETGO_ROOT@/scripts/boot/time-sync.sh
|
||||||
|
StandardOutput=append:@BLITZ_LOG_FILE@
|
||||||
|
StandardError=append:@BLITZ_LOG_FILE@
|
||||||
|
|
||||||
|
[Install]
|
||||||
|
WantedBy=blitz-robot.target
|
||||||
113
scripts/boot/time-sync.sh
Normal file
113
scripts/boot/time-sync.sh
Normal file
@@ -0,0 +1,113 @@
|
|||||||
|
#!/usr/bin/env bash
|
||||||
|
set -euo pipefail
|
||||||
|
|
||||||
|
SCRIPT_DIR="$(cd "$(dirname "${BASH_SOURCE[0]}")" && pwd)"
|
||||||
|
# shellcheck disable=SC1091
|
||||||
|
source "${SCRIPT_DIR}/common.sh"
|
||||||
|
|
||||||
|
STEP="time-sync"
|
||||||
|
CHRONY_SOURCES_DIR="/etc/chrony/sources.d"
|
||||||
|
CHRONY_SOURCE_FILE="${CHRONY_SOURCES_DIR}/blitz-robot.sources"
|
||||||
|
CHRONY_MAIN_CONF="/etc/chrony/chrony.conf"
|
||||||
|
CHRONY_MAIN_CONF_BAK="/etc/chrony/chrony.conf.blitz-bak"
|
||||||
|
|
||||||
|
chrony_unit_name() {
|
||||||
|
if systemctl list-unit-files chrony.service --no-legend 2>/dev/null | grep -q '^chrony\.service'; then
|
||||||
|
printf '%s\n' "chrony.service"
|
||||||
|
return 0
|
||||||
|
fi
|
||||||
|
if systemctl list-unit-files chronyd.service --no-legend 2>/dev/null | grep -q '^chronyd\.service'; then
|
||||||
|
printf '%s\n' "chronyd.service"
|
||||||
|
return 0
|
||||||
|
fi
|
||||||
|
printf '%s\n' "chrony.service"
|
||||||
|
}
|
||||||
|
|
||||||
|
ensure_chrony_main_conf() {
|
||||||
|
local temp_file
|
||||||
|
|
||||||
|
blitz_require_file "${CHRONY_MAIN_CONF}" "${STEP}"
|
||||||
|
mkdir -p "${CHRONY_SOURCES_DIR}"
|
||||||
|
|
||||||
|
if [[ ! -f "${CHRONY_MAIN_CONF_BAK}" ]]; then
|
||||||
|
cp -a "${CHRONY_MAIN_CONF}" "${CHRONY_MAIN_CONF_BAK}"
|
||||||
|
blitz_log "${STEP}" "backup-config" "success" "backup=${CHRONY_MAIN_CONF_BAK}" 0
|
||||||
|
fi
|
||||||
|
|
||||||
|
temp_file="$(mktemp)"
|
||||||
|
awk '
|
||||||
|
/^[[:space:]]*#/ { print; next }
|
||||||
|
/^[[:space:]]*(pool|server)[[:space:]]+/ {
|
||||||
|
print "# blitz-managed-disabled " $0
|
||||||
|
next
|
||||||
|
}
|
||||||
|
{ print }
|
||||||
|
' "${CHRONY_MAIN_CONF}" > "${temp_file}"
|
||||||
|
|
||||||
|
if ! grep -Eq '^[[:space:]]*sourcedir[[:space:]]+/etc/chrony/sources\.d([[:space:]]|$)' "${temp_file}"; then
|
||||||
|
printf '\n# blitz-managed\nsourcedir /etc/chrony/sources.d\n' >> "${temp_file}"
|
||||||
|
fi
|
||||||
|
|
||||||
|
if ! cmp -s "${temp_file}" "${CHRONY_MAIN_CONF}"; then
|
||||||
|
cp "${temp_file}" "${CHRONY_MAIN_CONF}"
|
||||||
|
blitz_log "${STEP}" "rewrite-main-config" "success" "commented non-Blitz pool/server entries in ${CHRONY_MAIN_CONF}" 0
|
||||||
|
else
|
||||||
|
blitz_log "${STEP}" "rewrite-main-config" "success" "main config already matches Blitz expectations" 0
|
||||||
|
fi
|
||||||
|
|
||||||
|
rm -f "${temp_file}"
|
||||||
|
}
|
||||||
|
|
||||||
|
write_chrony_source_file() {
|
||||||
|
local temp_file
|
||||||
|
|
||||||
|
temp_file="$(mktemp)"
|
||||||
|
cat <<EOF > "${temp_file}"
|
||||||
|
# blitz-managed
|
||||||
|
server ${BLITZ_TIME_SERVER_IP} port ${BLITZ_TIME_SERVER_PORT} iburst
|
||||||
|
EOF
|
||||||
|
|
||||||
|
if [[ ! -f "${CHRONY_SOURCE_FILE}" ]] || ! cmp -s "${temp_file}" "${CHRONY_SOURCE_FILE}"; then
|
||||||
|
cp "${temp_file}" "${CHRONY_SOURCE_FILE}"
|
||||||
|
blitz_log "${STEP}" "write-source" "success" "source_file=${CHRONY_SOURCE_FILE} server=${BLITZ_TIME_SERVER_IP} port=${BLITZ_TIME_SERVER_PORT}" 0
|
||||||
|
else
|
||||||
|
blitz_log "${STEP}" "write-source" "success" "source_file already matches ${BLITZ_TIME_SERVER_IP}:${BLITZ_TIME_SERVER_PORT}" 0
|
||||||
|
fi
|
||||||
|
|
||||||
|
rm -f "${temp_file}"
|
||||||
|
}
|
||||||
|
|
||||||
|
blitz_load_boot_env
|
||||||
|
blitz_require_root "${STEP}"
|
||||||
|
blitz_require_command systemctl "${STEP}"
|
||||||
|
blitz_require_command chronyc "${STEP}"
|
||||||
|
|
||||||
|
if [[ -z "${BLITZ_TIME_SERVER_IP}" ]]; then
|
||||||
|
blitz_log "${STEP}" "precheck" "failure" "BLITZ_TIME_SERVER_IP is empty and no fallback could be derived" 1
|
||||||
|
exit 1
|
||||||
|
fi
|
||||||
|
if ! [[ "${BLITZ_TIME_SERVER_PORT}" =~ ^[0-9]+$ ]] || (( BLITZ_TIME_SERVER_PORT < 1 || BLITZ_TIME_SERVER_PORT > 65535 )); then
|
||||||
|
blitz_log "${STEP}" "precheck" "failure" "BLITZ_TIME_SERVER_PORT must be an integer between 1 and 65535" 1
|
||||||
|
exit 1
|
||||||
|
fi
|
||||||
|
|
||||||
|
ensure_chrony_main_conf
|
||||||
|
write_chrony_source_file
|
||||||
|
|
||||||
|
CHRONY_UNIT="$(chrony_unit_name)"
|
||||||
|
blitz_run "${STEP}" "restart-chrony" systemctl restart "${CHRONY_UNIT}"
|
||||||
|
blitz_run "${STEP}" "burst" chronyc burst
|
||||||
|
|
||||||
|
blitz_log "${STEP}" "waitsync" "start" "server=${BLITZ_TIME_SERVER_IP} port=${BLITZ_TIME_SERVER_PORT} wait_sec=${BLITZ_TIME_SYNC_WAIT_SEC} max_offset_sec=${BLITZ_TIME_SYNC_MAX_OFFSET_SEC} interval_sec=${BLITZ_TIME_SYNC_INTERVAL_SEC}" 0
|
||||||
|
if chronyc waitsync "${BLITZ_TIME_SYNC_WAIT_SEC}" "${BLITZ_TIME_SYNC_MAX_OFFSET_SEC}" 1000 "${BLITZ_TIME_SYNC_INTERVAL_SEC}"; then
|
||||||
|
blitz_log "${STEP}" "waitsync" "success" "chrony synchronized to ${BLITZ_TIME_SERVER_IP}:${BLITZ_TIME_SERVER_PORT}" 0
|
||||||
|
else
|
||||||
|
rc=$?
|
||||||
|
blitz_log "${STEP}" "waitsync" "soft_fail" "chrony did not synchronize to ${BLITZ_TIME_SERVER_IP}:${BLITZ_TIME_SERVER_PORT} within the configured timeout" "${rc}"
|
||||||
|
fi
|
||||||
|
|
||||||
|
blitz_log "${STEP}" "tracking" "start" "chronyc tracking" 0
|
||||||
|
chronyc tracking || true
|
||||||
|
blitz_log "${STEP}" "sources" "start" "chronyc sources -v" 0
|
||||||
|
chronyc sources -v || true
|
||||||
|
blitz_log "${STEP}" "complete" "success" "time-sync step finished" 0
|
||||||
49
scripts/boot/wait-for-unix-socket.sh
Normal file
49
scripts/boot/wait-for-unix-socket.sh
Normal file
@@ -0,0 +1,49 @@
|
|||||||
|
#!/usr/bin/env bash
|
||||||
|
set -euo pipefail
|
||||||
|
|
||||||
|
SCRIPT_DIR="$(cd "$(dirname "${BASH_SOURCE[0]}")" && pwd)"
|
||||||
|
# shellcheck disable=SC1091
|
||||||
|
source "${SCRIPT_DIR}/common.sh"
|
||||||
|
|
||||||
|
STEP="ros-receiver"
|
||||||
|
SOCKET_PATH=""
|
||||||
|
TIMEOUT_SEC=""
|
||||||
|
|
||||||
|
while [[ $# -gt 0 ]]; do
|
||||||
|
case "$1" in
|
||||||
|
--path)
|
||||||
|
SOCKET_PATH="$2"
|
||||||
|
shift 2
|
||||||
|
;;
|
||||||
|
--timeout)
|
||||||
|
TIMEOUT_SEC="$2"
|
||||||
|
shift 2
|
||||||
|
;;
|
||||||
|
--step)
|
||||||
|
STEP="$2"
|
||||||
|
shift 2
|
||||||
|
;;
|
||||||
|
*)
|
||||||
|
blitz_log "${STEP}" "wait-socket-arg" "failure" "unknown argument: $1" 2
|
||||||
|
exit 2
|
||||||
|
;;
|
||||||
|
esac
|
||||||
|
done
|
||||||
|
|
||||||
|
blitz_load_boot_env
|
||||||
|
|
||||||
|
SOCKET_PATH="${SOCKET_PATH:-${ROBOT_RECEIVER_LOCAL_SOCKET_PATH}}"
|
||||||
|
TIMEOUT_SEC="${TIMEOUT_SEC:-${BLITZ_ROS_SOCKET_WAIT_SEC}}"
|
||||||
|
|
||||||
|
blitz_log "${STEP}" "wait-socket" "start" "path=${SOCKET_PATH} timeout_sec=${TIMEOUT_SEC}" 0
|
||||||
|
|
||||||
|
for (( waited=0; waited< TIMEOUT_SEC; waited++ )); do
|
||||||
|
if [[ -S "${SOCKET_PATH}" ]]; then
|
||||||
|
blitz_log "${STEP}" "wait-socket" "success" "path=${SOCKET_PATH} waited_sec=${waited}" 0
|
||||||
|
exit 0
|
||||||
|
fi
|
||||||
|
sleep 1
|
||||||
|
done
|
||||||
|
|
||||||
|
blitz_log "${STEP}" "wait-socket" "failure" "path=${SOCKET_PATH} timeout_sec=${TIMEOUT_SEC}" 1
|
||||||
|
exit 1
|
||||||
@@ -15,6 +15,10 @@ export OMNI_CONTROL_SERVER_ADDR="${OMNI_CONTROL_SERVER_ADDR}"
|
|||||||
export OMNI_CONTROL_RELAY_VIA="${OMNI_CONTROL_RELAY_VIA}"
|
export OMNI_CONTROL_RELAY_VIA="${OMNI_CONTROL_RELAY_VIA}"
|
||||||
|
|
||||||
if [[ ! -x "./bin/b_side_omnid" ]]; then
|
if [[ ! -x "./bin/b_side_omnid" ]]; then
|
||||||
|
if [[ "${OMNI_BOOT_MODE:-0}" == "1" ]]; then
|
||||||
|
echo "Missing ./bin/b_side_omnid in boot mode; build it before enabling the autostart service." >&2
|
||||||
|
exit 1
|
||||||
|
fi
|
||||||
make b_side_omnid
|
make b_side_omnid
|
||||||
fi
|
fi
|
||||||
|
|
||||||
|
|||||||
@@ -12,9 +12,17 @@ source_with_nounset_off() {
|
|||||||
|
|
||||||
# shellcheck disable=SC1091
|
# shellcheck disable=SC1091
|
||||||
source "${SCRIPT_DIR}/load-env.sh"
|
source "${SCRIPT_DIR}/load-env.sh"
|
||||||
|
if [[ ! -f "/opt/ros/${ROS_DISTRO}/setup.bash" ]]; then
|
||||||
|
echo "Missing ROS distro setup: /opt/ros/${ROS_DISTRO}/setup.bash" >&2
|
||||||
|
exit 1
|
||||||
|
fi
|
||||||
source_with_nounset_off "/opt/ros/${ROS_DISTRO}/setup.bash"
|
source_with_nounset_off "/opt/ros/${ROS_DISTRO}/setup.bash"
|
||||||
|
|
||||||
cd "${ROS_CONTROL_PY_DIR}"
|
cd "${ROS_CONTROL_PY_DIR}"
|
||||||
|
if [[ ! -f "install/setup.bash" ]]; then
|
||||||
|
echo "Missing ROS workspace setup: ${ROS_CONTROL_PY_DIR}/install/setup.bash" >&2
|
||||||
|
exit 1
|
||||||
|
fi
|
||||||
source_with_nounset_off "install/setup.bash"
|
source_with_nounset_off "install/setup.bash"
|
||||||
|
|
||||||
launch_args=(
|
launch_args=(
|
||||||
|
|||||||
Reference in New Issue
Block a user