IMG/cpio/ventoy/hook/ventoy-hook-lib.sh

   1 #!/ventoy/busybox/sh
   2 #************************************************************************************
   3 # Copyright (c) 2020, longpanda <admin@ventoy.net>
   4 #
   5 # This program is free software; you can redistribute it and/or
   6 # modify it under the terms of the GNU General Public License as
   7 # published by the Free Software Foundation; either version 3 of the
   8 # License, or (at your option) any later version.
   9 #
  10 # This program is distributed in the hope that it will be useful, but
  11 # WITHOUT ANY WARRANTY; without even the implied warranty of
  12 # MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  13 # General Public License for more details.
  14 #
  15 # You should have received a copy of the GNU General Public License
  16 # along with this program; if not, see <http://www.gnu.org/licenses/>.
  17 #
  18 #************************************************************************************
  19
  20 VTOY_PATH=/ventoy
  21 BUSYBOX_PATH=$VTOY_PATH/busybox
  22 VTLOG=$VTOY_PATH/log
  23 FIND=$BUSYBOX_PATH/find
  24 GREP=$BUSYBOX_PATH/grep
  25 EGREP=$BUSYBOX_PATH/egrep
  26 CAT=$BUSYBOX_PATH/cat
  27 AWK=$BUSYBOX_PATH/awk
  28 SED=$BUSYBOX_PATH/sed
  29 SLEEP=$BUSYBOX_PATH/sleep
  30 HEAD=$BUSYBOX_PATH/head
  31 VTOY_DM_PATH=/dev/mapper/ventoy
  32 VTOY_DEBUG_LEVEL=$($BUSYBOX_PATH/hexdump -n 1 -s 450 -e '1/1 "%02x"' $VTOY_PATH/ventoy_os_param)
  33 VTOY_LINUX_REMOUNT=$($BUSYBOX_PATH/hexdump -n 1 -s 454 -e '1/1 "%02x"' $VTOY_PATH/ventoy_os_param)
  34 VTOY_VLNK_BOOT=$($BUSYBOX_PATH/hexdump -n 1 -s 455 -e '1/1 "%02x"' $VTOY_PATH/ventoy_os_param)
  35
  36 if [ "$VTOY_DEBUG_LEVEL" = "01" ]; then
  37     if [ -e /dev/console ]; then
  38         VTLOG=/dev/console
  39     fi
  40 fi
  41
  42 vtlog() {
  43     if [ "$VTLOG" = "$VTOY_PATH/log" ]; then
  44         echo "$*" >>$VTLOG
  45     else
  46         echo -e "\033[32m $* \033[0m" > $VTLOG
  47         $SLEEP 2
  48     fi
  49 }
  50
  51 vterr() {
  52     if [ "$VTLOG" = "$VTOY_PATH/log" ]; then
  53         echo "$*" >>$VTLOG
  54     else
  55         echo -e "\n\033[31m $* \033[0m" > $VTLOG
  56         $SLEEP 30
  57     fi
  58 }
  59
  60
  61 is_ventoy_hook_finished() {
  62     [ -e $VTOY_PATH/hook_finish ]
  63 }
  64
  65 set_ventoy_hook_finish() {
  66     echo 'Y' > $VTOY_PATH/hook_finish
  67 }
  68
  69 get_ventoy_disk_name() {
  70     if [ "$VTOY_VLNK_BOOT" = "01" ]; then
  71         $VTOY_PATH/tool/vtoydump -t /ventoy/ventoy_os_param
  72     else
  73         line=$($VTOY_PATH/tool/vtoydump -f /ventoy/ventoy_os_param)
  74         if [ $? -eq 0 ]; then
  75             echo ${line%%#*}
  76         else
  77             echo "unknown"
  78         fi
  79     fi
  80 }
  81
  82 get_ventoy_iso_name() {
  83     line=$($VTOY_PATH/tool/vtoydump -f /ventoy/ventoy_os_param)
  84     if [ $? -eq 0 ]; then
  85         echo ${line##*#}
  86     else
  87         echo "unknown"
  88     fi
  89 }
  90
  91 wait_for_usb_disk_ready() {
  92     vtloop=0
  93     while [ -n "Y" ]; do
  94         usb_disk=$(get_ventoy_disk_name)
  95         vtlog "wait_for_usb_disk_ready $usb_disk ..."
  96
  97         if echo $usb_disk | $EGREP -q "nvme|mmc|nbd"; then
  98             vtpart2=${usb_disk}p2
  99         else
 100             vtpart2=${usb_disk}2
 101         fi
 102
 103         if [ -e "${vtpart2}" ]; then
 104             vtlog "wait_for_usb_disk_ready $usb_disk finish"
 105             break
 106         else
 107             let vtloop=vtloop+1
 108             if [ $vtloop -gt 2 ]; then
 109                 if [ "$VTLOG" != "$VTOY_PATH/log" ]; then
 110                     $VTOY_PATH/tool/vtoydump -f /ventoy/ventoy_os_param -v > $VTLOG
 111                 fi
 112             fi
 113             $SLEEP 0.3
 114         fi
 115     done
 116 }
 117
 118
 119 check_usb_disk_ready() {
 120     if echo $1 | $EGREP -q "nvme|mmc|nbd"; then
 121         vtpart2=${1}p2
 122     else
 123         vtpart2=${1}2
 124     fi
 125
 126     [ -e "${vtpart2}" ]
 127 }
 128
 129 not_ventoy_disk() {
 130     if echo $1 | $EGREP -q "nvme.*p$|mmc.*p$|nbd.*p$"; then
 131         vtDiskName=${1:0:-1}
 132     else
 133         vtDiskName=$1
 134     fi
 135
 136     if [ "$VTOY_VLNK_BOOT" = "01" ]; then
 137         vtVtoyDisk=$($VTOY_PATH/tool/vtoydump -t $VTOY_PATH/ventoy_os_param)
 138         [ "$vtVtoyDisk" != "/dev/$vtDiskName" ]
 139     else
 140         if $VTOY_PATH/tool/vtoydump -f $VTOY_PATH/ventoy_os_param -c "$vtDiskName"; then
 141             $BUSYBOX_PATH/false
 142         else
 143             $BUSYBOX_PATH/true
 144         fi
 145     fi
 146 }
 147
 148 ventoy_get_vblade_bin() {
 149     if $VTOY_PATH/tool/vblade_64 -t >>$VTLOG 2>&1; then
 150         echo $VTOY_PATH/tool/vblade_64
 151     else
 152         echo $VTOY_PATH/tool/vblade_32
 153     fi
 154 }
 155
 156 ventoy_find_bin_path() {
 157     if $BUSYBOX_PATH/which "$1" > /dev/null; then
 158         $BUSYBOX_PATH/which "$1"; return
 159     fi
 160
 161     for vt_path in '/bin' '/sbin' '/usr/bin' '/usr/sbin' '/usr/local/bin' '/usr/local/sbin' '/root/bin'; do
 162         if [ -e "$vt_path/$1" ]; then
 163             echo "$vt_path/$1"; return
 164         fi
 165     done
 166
 167     echo ""
 168 }
 169
 170
 171 ventoy_find_bin_run() {
 172     vtsudo=0
 173     if [ "$1" = "sudo" ]; then
 174         shift
 175         vtsudo=1
 176     fi
 177
 178     vtbinpath=$(ventoy_find_bin_path "$1")
 179     if [ -n "$vtbinpath" ]; then
 180         shift
 181
 182         if [ $vtsudo -eq 0 ]; then
 183             vtlog "$vtbinpath $*"
 184             $vtbinpath $*
 185         else
 186             vtlog "sudo $vtbinpath $*"
 187             sudo $vtbinpath $*
 188         fi
 189     fi
 190 }
 191
 192 ventoy_get_module_postfix() {
 193     vtKerVer=$($BUSYBOX_PATH/uname -r)
 194     vtLine=$($FIND /lib/modules/$vtKerVer/ -name *.ko* | $HEAD -n1)
 195     vtComp=${vtLine##*/*.ko}
 196     echo "ko$vtComp"
 197 }
 198
 199 ventoy_check_dm_module() {
 200     if $GREP -q 'device-mapper' /proc/devices; then
 201         $BUSYBOX_PATH/true; return
 202     fi
 203
 204     vtlog "device-mapper NOT found in /proc/devices, try to load kernel module"
 205     $BUSYBOX_PATH/modprobe dm_mod >>$VTLOG 2>&1
 206     $BUSYBOX_PATH/modprobe dm-mod >>$VTLOG 2>&1
 207
 208     if ! $GREP -q 'device-mapper' /proc/devices; then
 209         vtlog "modprobe failed, now try to insmod ko..."
 210
 211         $FIND /lib/modules/ -name "dm-mod.ko*" | while read vtline; do
 212             vtlog "insmod $vtline "
 213             $BUSYBOX_PATH/insmod $vtline >>$VTLOG 2>&1
 214             if [ $? -eq 0 ]; then
 215                 vtlog "insmod success"
 216             else
 217                 vtlog "insmod failed, try decompress"
 218                 if echo $vtline | $GREP -q "\.zst"; then
 219                     $VTOY_PATH/tool/zstdcat $vtline > $VTOY_PATH/extract_dm_mod.ko
 220                     $BUSYBOX_PATH/insmod $VTOY_PATH/extract_dm_mod.ko >>$VTLOG 2>&1
 221                 fi
 222             fi
 223         done
 224     fi
 225
 226     if $GREP -q 'device-mapper' /proc/devices; then
 227         vtlog "device-mapper found in /proc/devices after retry"
 228         $BUSYBOX_PATH/true; return
 229     else
 230         vtlog "device-mapper still NOT found in /proc/devices after retry"
 231         $BUSYBOX_PATH/false; return
 232     fi
 233 }
 234
 235 ventoy_need_proc_ibt() {
 236     vtKv=$($BUSYBOX_PATH/uname -r)
 237     vtMajor=$(echo $vtKv | $AWK -F. '{print $1}')
 238     vtMinor=$(echo $vtKv | $AWK -F. '{print $2}')
 239
 240     #ibt was supported since linux kernel 5.18
 241     if [ $vtMajor -lt 5 ]; then
 242         $BUSYBOX_PATH/false; return
 243     elif [ $vtMajor -eq 5 ]; then
 244         if [ $vtMajor -lt 18 ]; then
 245             $BUSYBOX_PATH/false; return
 246         fi
 247     fi
 248
 249     if $GREP -q ' ibt=off' /proc/cmdline; then
 250         $BUSYBOX_PATH/false; return
 251     fi
 252
 253     #hardware CPU doesn't support IBT
 254     if $VTOY_PATH/tool/vtoykmod -I; then
 255         :
 256     else
 257         $BUSYBOX_PATH/false; return
 258     fi
 259
 260     #dot.CONFIG not enabled
 261     if $GREP -q ' ibt_restore$' /proc/kallsyms; then
 262         :
 263     else
 264         $BUSYBOX_PATH/false; return
 265     fi
 266
 267     $BUSYBOX_PATH/true
 268 }
 269
 270
 271 ventoy_need_dm_patch() {
 272     if [ "$VTOY_LINUX_REMOUNT" != "01" ]; then
 273         if $GREP -q 'VTOY_LINUX_REMOUNT=1' /proc/cmdline; then
 274             :
 275         else
 276             $BUSYBOX_PATH/false; return
 277         fi
 278     fi
 279
 280     if $GREP -q 'device-mapper' /proc/devices; then
 281         :
 282     else
 283         $BUSYBOX_PATH/false; return
 284     fi
 285
 286     if $GREP -q 'dm_patch' /proc/modules; then
 287         $BUSYBOX_PATH/false; return
 288     fi
 289
 290     vtMajorVer=$($BUSYBOX_PATH/uname -r | $AWK -F. '{print $1}')
 291     vtMinorVer=$($BUSYBOX_PATH/uname -r | $AWK -F. '{print $2}')
 292
 293     if [ $vtMajorVer -lt 3 ]; then
 294         $BUSYBOX_PATH/false; return
 295     elif [ $vtMajorVer -eq 3 -a $vtMinorVer -lt 10 ]; then
 296         $BUSYBOX_PATH/false; return
 297     fi
 298
 299
 300     $BUSYBOX_PATH/true
 301 }
 302
 303 ventoy_dm_patch() {
 304     vtDmPatchDebug=0
 305     vtMType=$($BUSYBOX_PATH/uname -m)
 306
 307     vtlog "######### ventoy_dm_patch ############"
 308
 309     if echo $vtMType | $EGREP -i -q "x86.64|amd64"; then
 310         vtKoName=dm_patch_64.ko
 311     elif echo $vtMType | $EGREP -i -q "i[3-6]86"; then
 312         vtKoName=dm_patch_32.ko
 313     else
 314         vtlog "unsupported machine type $vtMType"
 315         return
 316     fi
 317
 318     if ventoy_need_proc_ibt; then
 319         vtlog "need to proc IBT"
 320         vtKoName=dm_patch_ibt_64.ko
 321         vtIBT='0x8888'
 322     else
 323         vtlog "NO need to proc IBT"
 324         vtIBT='0'
 325     fi
 326
 327
 328     if [ -f $VTOY_PATH/tool/$vtKoName ]; then
 329         vtlog "/ventoy/tool/$vtKoName exist OK"
 330     else
 331         vtlog "/ventoy/tool/$vtKoName NOT exist"
 332         return
 333     fi
 334
 335     $CAT /proc/kallsyms | $BUSYBOX_PATH/sort > $VTOY_PATH/kallsyms
 336
 337     if $GREP -m1 -q 'open_table_device.isra' $VTOY_PATH/kallsyms; then
 338         vtLine=$($VTOY_PATH/tool/vtoyksym open_table_device.isra $VTOY_PATH/kallsyms)
 339         vtlog "get open_table_device.isra address $vtLine"
 340     else
 341         vtLine=$($VTOY_PATH/tool/vtoyksym dm_get_table_device $VTOY_PATH/kallsyms)
 342         vtlog "get dm_get_table_device address $vtLine"
 343     fi
 344     get_addr=$(echo $vtLine | $AWK '{print $1}')
 345     get_size=$(echo $vtLine | $AWK '{print $2}')
 346
 347     if $GREP -m1 -q 'close_table_device.isra' $VTOY_PATH/kallsyms; then
 348         vtLine=$($VTOY_PATH/tool/vtoyksym close_table_device.isra $VTOY_PATH/kallsyms)
 349         vtlog "get close_table_device.isra address $vtLine"
 350     else
 351         vtLine=$($VTOY_PATH/tool/vtoyksym dm_put_table_device $VTOY_PATH/kallsyms)
 352         vtlog "get dm_put_table_device address $vtLine"
 353     fi
 354     put_addr=$(echo $vtLine | $AWK '{print $1}')
 355     put_size=$(echo $vtLine | $AWK '{print $2}')
 356
 357     ro_addr=$($GREP ' set_memory_ro$' /proc/kallsyms | $AWK '{print $1}')
 358     rw_addr=$($GREP ' set_memory_rw$' /proc/kallsyms | $AWK '{print $1}')
 359     kprobe_reg_addr=$($GREP ' register_kprobe$' /proc/kallsyms | $AWK '{print $1}')
 360     kprobe_unreg_addr=$($GREP ' unregister_kprobe$' /proc/kallsyms | $AWK '{print $1}')
 361
 362     if [ "$VTOY_DEBUG_LEVEL" = "01" ]; then
 363         vtDmPatchDebug=1
 364     fi
 365
 366     if $GREP -q 'dmpatch_debug' /proc/cmdline; then
 367         vtDmPatchDebug=1
 368     fi
 369
 370
 371     if [ $vtDmPatchDebug -eq 1 ]; then
 372         printk_addr=$($GREP ' printk$' /proc/kallsyms | $AWK '{print $1}')
 373         if [ -z "$printk_addr" ]; then
 374             printk_addr=$($GREP ' _printk$' /proc/kallsyms | $AWK '{print $1}')
 375         fi
 376         vtDebug="-v"
 377     else
 378         printk_addr=0
 379     fi
 380
 381     #printk_addr=$($GREP ' printk$' /proc/kallsyms | $AWK '{print $1}')
 382     #vtDebug="-v"
 383
 384     vtlog get_addr=$get_addr  get_size=$get_size
 385     vtlog put_addr=$put_addr  put_size=$put_size
 386     vtlog kprobe_reg_addr=$kprobe_reg_addr  kprobe_unreg_addr=$kprobe_unreg_addr
 387     vtlog ro_addr=$ro_addr  rw_addr=$rw_addr  printk_addr=$printk_addr
 388
 389     if [ "$get_addr" = "0" -o "$put_addr" = "0" ]; then
 390         vtlog "Invalid symbol address"
 391         return
 392     fi
 393     if [ "$ro_addr" = "0" -o "$rw_addr" = "0" ]; then
 394         vtlog "Invalid symbol address"
 395         return
 396     fi
 397
 398
 399     vtKv=$($BUSYBOX_PATH/uname -r)
 400
 401     if [ ! -d /lib/modules/$vtKv ]; then
 402         vtlog "No modules directory found"
 403         return
 404     elif [ -d /lib/modules/$vtKv/kernel/fs ]; then
 405         vtModPath=$($FIND /lib/modules/$vtKv/kernel/fs/ -name "*.ko*" | $HEAD -n1)
 406     elif [ -d /lib/modules/$vtKv/kernel ]; then
 407         vtModPath=$($FIND /lib/modules/$vtKv/kernel/ -name "xfs.ko*" | $HEAD -n1)
 408     elif [ -d /lib/modules/$vtKv/initrd ]; then
 409         vtModPath=$($FIND /lib/modules/$vtKv/initrd/ -name "xfs.ko*" | $HEAD -n1)
 410     fi
 411
 412
 413     if [ -z "$vtModPath" ]; then
 414         vtModPath=$($FIND /lib/modules/$vtKv/ -name "*.ko*" | $HEAD -n1)
 415     fi
 416
 417     vtModName=$($BUSYBOX_PATH/basename $vtModPath)
 418
 419     vtlog "template module is $vtModPath $vtModName"
 420
 421     if [ -z "$vtModPath" ]; then
 422         vtlog "No template module found"
 423         return
 424     elif echo $vtModPath | $GREP -q "[.]ko$"; then
 425         $BUSYBOX_PATH/cp -a $vtModPath  $VTOY_PATH/$vtModName
 426     elif echo $vtModPath | $GREP -q "[.]ko[.]xz$"; then
 427         $BUSYBOX_PATH/xzcat $vtModPath > $VTOY_PATH/$vtModName
 428     elif echo $vtModPath | $GREP -q "[.]ko[.]gz$"; then
 429         $BUSYBOX_PATH/zcat $vtModPath > $VTOY_PATH/$vtModName
 430     elif echo $vtModPath | $GREP -q "[.]ko[.]zst$"; then
 431         $VTOY_PATH/tool/zstdcat $vtModPath > $VTOY_PATH/$vtModName
 432     else
 433         vtlog "unsupport module type"
 434         return
 435     fi
 436
 437
 438
 439     #step1: modify vermagic/mod crc/relocation
 440     vtlog "$VTOY_PATH/tool/vtoykmod -u $VTOY_PATH/tool/$vtKoName $VTOY_PATH/$vtModName $vtDebug"
 441     $VTOY_PATH/tool/vtoykmod -u $VTOY_PATH/tool/$vtKoName $VTOY_PATH/$vtModName $vtDebug >>$VTLOG 2>&1
 442
 443     #step2: fill parameters
 444     vtPgsize=$($VTOY_PATH/tool/vtoyksym -p)
 445     vtlog "$VTOY_PATH/tool/vtoykmod -f $VTOY_PATH/tool/$vtKoName $vtPgsize 0x$printk_addr 0x$ro_addr 0x$rw_addr $get_addr $get_size $put_addr $put_size 0x$kprobe_reg_addr 0x$kprobe_unreg_addr $vtKv $vtIBT $vtDebug"
 446     $VTOY_PATH/tool/vtoykmod -f $VTOY_PATH/tool/$vtKoName $vtPgsize 0x$printk_addr 0x$ro_addr 0x$rw_addr $get_addr $get_size $put_addr $put_size 0x$kprobe_reg_addr 0x$kprobe_unreg_addr $vtKv $vtIBT $vtDebug >>$VTLOG 2>&1
 447
 448     vtlog "insmod $VTOY_PATH/tool/$vtKoName"
 449     $BUSYBOX_PATH/insmod $VTOY_PATH/tool/$vtKoName  >>$VTLOG 2>&1
 450
 451     if $GREP -q 'dm_patch' /proc/modules; then
 452         vtlog "dm_patch module OK"
 453         echo "done" > $VTOY_PATH/dm_patch_done
 454     else
 455         vtlog "dm_patch module FAILED"
 456     fi
 457
 458 }
 459
 460 create_ventoy_device_mapper() {
 461     vtlog "create_ventoy_device_mapper $*"
 462
 463     VT_DM_BIN=$(ventoy_find_bin_path dmsetup)
 464     if [ -z "$VT_DM_BIN" ]; then
 465         vtlog "no dmsetup avaliable, lastly try inbox dmsetup"
 466         VT_DM_BIN=$VTOY_PATH/tool/dmsetup
 467     fi
 468
 469     vtlog "dmsetup avaliable in system $VT_DM_BIN"
 470
 471     if ventoy_check_dm_module "$1"; then
 472         vtlog "device-mapper module check success"
 473     else
 474         vterr "Error: no dm module avaliable"
 475     fi
 476
 477     $VTOY_PATH/tool/vtoydm -p -f $VTOY_PATH/ventoy_image_map -d $1 > $VTOY_PATH/ventoy_dm_table
 478
 479
 480     vtLevel1=$($CAT /proc/sys/kernel/printk | $AWK '{print $1}')
 481     vtLevel2=$($CAT /proc/sys/kernel/printk | $AWK '{print $2}')
 482     vtLevel3=$($CAT /proc/sys/kernel/printk | $AWK '{print $3}')
 483     vtLevel4=$($CAT /proc/sys/kernel/printk | $AWK '{print $4}')
 484     if ventoy_need_dm_patch; then
 485         ventoy_dm_patch
 486         #suppress printk message
 487         echo 0 $vtLevel2 0 $vtLevel4 > /proc/sys/kernel/printk
 488     fi
 489
 490     if [ -z "$2" ]; then
 491         $VT_DM_BIN create ventoy $VTOY_PATH/ventoy_dm_table >>$VTLOG 2>&1
 492     else
 493         $VT_DM_BIN "$2" create ventoy $VTOY_PATH/ventoy_dm_table >>$VTLOG 2>&1
 494     fi
 495
 496     if ventoy_need_dm_patch; then
 497         #recover printk level
 498         echo $vtLevel1 $vtLevel2 $vtLevel3 $vtLevel4 > /proc/sys/kernel/printk
 499     fi
 500 }
 501
 502 create_persistent_device_mapper() {
 503     vtlog "create_persistent_device_mapper $*"
 504
 505     VT_DM_BIN=$(ventoy_find_bin_path dmsetup)
 506     if [ -z "$VT_DM_BIN" ]; then
 507         vtlog "no dmsetup avaliable, lastly try inbox dmsetup"
 508         VT_DM_BIN=$VTOY_PATH/tool/dmsetup
 509     fi
 510
 511     vtlog "dmsetup avaliable in system $VT_DM_BIN"
 512
 513     if ventoy_check_dm_module "$1"; then
 514         vtlog "device-mapper module check success"
 515     else
 516         vterr "Error: no dm module avaliable"
 517     fi
 518
 519     $VTOY_PATH/tool/vtoydm -p -f $VTOY_PATH/ventoy_persistent_map -d $1 > $VTOY_PATH/persistent_dm_table
 520
 521
 522     vtLevel1=$($CAT /proc/sys/kernel/printk | $AWK '{print $1}')
 523     vtLevel2=$($CAT /proc/sys/kernel/printk | $AWK '{print $2}')
 524     vtLevel3=$($CAT /proc/sys/kernel/printk | $AWK '{print $3}')
 525     vtLevel4=$($CAT /proc/sys/kernel/printk | $AWK '{print $4}')
 526     if [ -f $VTOY_PATH/dm_patch_done ]; then
 527         #suppress printk message
 528         echo 0 $vtLevel2 0 $vtLevel4 > /proc/sys/kernel/printk
 529     fi
 530
 531     $VT_DM_BIN create vtoy_persistent $VTOY_PATH/persistent_dm_table >>$VTLOG 2>&1
 532
 533     if [ -f $VTOY_PATH/dm_patch_done ]; then
 534         #recover printk level
 535         echo $vtLevel1 $vtLevel2 $vtLevel3 $vtLevel4 > /proc/sys/kernel/printk
 536     fi
 537 }
 538
 539
 540
 541 wait_for_ventoy_dm_disk_label() {
 542     DM=$($BUSYBOX_PATH/readlink $VTOY_DM_PATH)
 543     vtlog "wait_for_ventoy_dm_disk_label $DM ..."
 544
 545     for i in 0 1 2 3 4 5 6 7 8 9; do
 546         vtlog "i=$i ####### ls /dev/disk/by-label/"
 547         ls -l /dev/disk/by-label/ >> $VTLOG
 548
 549         if ls -l /dev/disk/by-label/ | $GREP -q "$DM"; then
 550             break
 551         else
 552             $SLEEP 1
 553         fi
 554     done
 555 }
 556
 557 install_udeb_pkg() {
 558     if ! [ -e "$1" ]; then
 559         $BUSYBOX_PATH/false
 560         return
 561     fi
 562
 563     if [ -d /tmp/vtoy_udeb ]; then
 564         $BUSYBOX_PATH/rm -rf /tmp/vtoy_udeb
 565     fi
 566
 567     $BUSYBOX_PATH/mkdir -p /tmp/vtoy_udeb
 568     $BUSYBOX_PATH/cp -a "$1" /tmp/vtoy_udeb/
 569
 570     CURDIR=$($BUSYBOX_PATH/pwd)
 571     cd /tmp/vtoy_udeb
 572
 573     $BUSYBOX_PATH/ar x "$1"
 574
 575     if [ -e 'data.tar.gz' ]; then
 576         $BUSYBOX_PATH/tar -xzf data.tar.gz -C /
 577     elif [ -e 'data.tar.xz' ]; then
 578         $BUSYBOX_PATH/tar -xJf data.tar.xz -C /
 579     elif [ -e 'data.tar.bz2' ]; then
 580         $BUSYBOX_PATH/tar -xjf data.tar.bz2 -C /
 581     elif [ -e 'data.tar.lzma' ]; then
 582         $BUSYBOX_PATH/tar -xaf data.tar.lzma -C /
 583     fi
 584
 585     if [ -e 'control.tar.gz' ]; then
 586         $BUSYBOX_PATH/tar -xzf control.tar.gz -C /
 587     elif [ -e 'control.tar.xz' ]; then
 588         $BUSYBOX_PATH/tar -xJf control.tar.xz -C /
 589     elif [ -e 'control.tar.bz2' ]; then
 590         $BUSYBOX_PATH/tar -xjf control.tar.bz2 -C /
 591     elif [ -e 'control.tar.lzma' ]; then
 592         $BUSYBOX_PATH/tar -xaf control.tar.lzma -C /
 593     fi
 594
 595     cd $CURDIR
 596     $BUSYBOX_PATH/rm -rf /tmp/vtoy_udeb
 597     $BUSYBOX_PATH/true
 598 }
 599
 600
 601 install_udeb_from_line() {
 602     vtlog "install_udeb_from_line $1"
 603
 604     if ! [ -b "$2" ]; then
 605         vterr "disk #$2# not exist"
 606         return
 607     fi
 608
 609     sector=$(echo $1 | $AWK '{print $(NF-1)}')
 610     length=$(echo $1 | $AWK '{print $NF}')
 611     vtlog "sector=$sector  length=$length"
 612
 613     $VTOY_PATH/tool/vtoydm -e -f $VTOY_PATH/ventoy_image_map -d ${2} -s $sector -l $length -o /tmp/xxx.udeb
 614     if [ -e /tmp/xxx.udeb ]; then
 615         vtlog "extract udeb file from iso success"
 616     else
 617         vterr "extract udeb file from iso fail"
 618         return
 619     fi
 620
 621     install_udeb_pkg /tmp/xxx.udeb
 622     $BUSYBOX_PATH/rm -f /tmp/xxx.udeb
 623 }
 624
 625 extract_file_from_line() {
 626     vtlog "extract_file_from_line $1 disk=#$2#"
 627     if ! [ -b "$2" ]; then
 628         vterr "disk #$2# not exist"
 629         return
 630     fi
 631
 632     sector=$(echo $1 | $AWK '{print $(NF-1)}')
 633     length=$(echo $1 | $AWK '{print $NF}')
 634     vtlog "sector=$sector  length=$length"
 635
 636     $VTOY_PATH/tool/vtoydm -e -f $VTOY_PATH/ventoy_image_map -d ${2} -s $sector -l $length -o $3
 637     if [ -e $3 ]; then
 638         vtlog "extract file from iso success"
 639         $BUSYBOX_PATH/true
 640     else
 641         vterr "extract file from iso fail"
 642         $BUSYBOX_PATH/false
 643     fi
 644 }
 645
 646 extract_rpm_from_line() {
 647     vtlog "extract_rpm_from_line $1 disk=#$2#"
 648
 649     if ! [ -b "$2" ]; then
 650         vterr "disk #$2# not exist"
 651         return
 652     fi
 653
 654     sector=$(echo $1 | $AWK '{print $(NF-1)}')
 655     length=$(echo $1 | $AWK '{print $NF}')
 656     vtlog "sector=$sector  length=$length"
 657
 658     $VTOY_PATH/tool/vtoydm -e -f $VTOY_PATH/ventoy_image_map -d ${2} -s $sector -l $length -o /tmp/xxx.rpm
 659     if [ -e /tmp/xxx.rpm ]; then
 660         vtlog "extract rpm file from iso success"
 661     else
 662         vterr "extract rpm file from iso fail"
 663         return
 664     fi
 665
 666     CURPWD=$($BUSYBOX_PATH/pwd)
 667
 668     $BUSYBOX_PATH/mkdir -p $VTOY_PATH/rpm
 669     cd $VTOY_PATH/rpm
 670     vtlog "extract rpm..."
 671     $BUSYBOX_PATH/rpm2cpio /tmp/xxx.rpm | $BUSYBOX_PATH/cpio -idm 2>>$VTLOG
 672     cd $CURPWD
 673
 674     $BUSYBOX_PATH/rm -f /tmp/xxx.rpm
 675 }
 676
 677 install_rpm_from_line() {
 678     vtlog "install_rpm_from_line $1 disk=#$2#"
 679
 680     if ! [ -b "$2" ]; then
 681         vterr "disk #$2# not exist"
 682         return
 683     fi
 684
 685     sector=$(echo $1 | $AWK '{print $(NF-1)}')
 686     length=$(echo $1 | $AWK '{print $NF}')
 687     vtlog "sector=$sector  length=$length"
 688
 689     $VTOY_PATH/tool/vtoydm -e -f $VTOY_PATH/ventoy_image_map -d ${2} -s $sector -l $length -o /tmp/xxx.rpm
 690     if [ -e /tmp/xxx.rpm ]; then
 691         vtlog "extract rpm file from iso success"
 692     else
 693         vterr "extract rpm file from iso fail"
 694         return
 695     fi
 696
 697     CURPWD=$($BUSYBOX_PATH/pwd)
 698
 699     cd /
 700     vtlog "install rpm..."
 701     $BUSYBOX_PATH/rpm2cpio /tmp/xxx.rpm | $BUSYBOX_PATH/cpio -idm 2>>$VTLOG
 702     cd $CURPWD
 703
 704     $BUSYBOX_PATH/rm -f /tmp/xxx.rpm
 705 }
 706
 707 dump_whole_iso_file() {
 708    $VTOY_PATH/tool/vtoydm -p -f $VTOY_PATH/ventoy_image_map -d $usb_disk | while read vtline; do
 709         vtlog "dmtable line: $vtline"
 710         vtcount=$(echo $vtline | $AWK '{print $2}')
 711         vtoffset=$(echo $vtline | $AWK '{print $NF}')
 712         $BUSYBOX_PATH/dd if=$usb_disk of="$1" bs=512 count=$vtcount skip=$vtoffset oflag=append conv=notrunc
 713     done
 714 }
 715
 716 ventoy_copy_device_mapper() {
 717     if [ -L $VTOY_DM_PATH ]; then
 718         vtlog "replace block device link $1..."
 719         $BUSYBOX_PATH/mv "$1" $VTOY_PATH/dev_backup_${1#/dev/}
 720         VT_MAPPER_LINK=$($BUSYBOX_PATH/readlink $VTOY_DM_PATH)
 721         $BUSYBOX_PATH/cp -a "/dev/mapper/$VT_MAPPER_LINK" "$1"
 722     elif [ -b $VTOY_DM_PATH ]; then
 723         vtlog "replace block device $1..."
 724         $BUSYBOX_PATH/mv "$1" $VTOY_PATH/dev_backup_${1#/dev/}
 725         $BUSYBOX_PATH/cp -a "$VTOY_DM_PATH" "$1"
 726     else
 727
 728         vtlog "$VTOY_DM_PATH not exist, now check /dev/dm-X ..."
 729         VT_DM_BIN=$(ventoy_find_bin_path dmsetup)
 730         if [ -z "$VT_DM_BIN" ]; then
 731             vtlog "no dmsetup avaliable, lastly try inbox dmsetup"
 732             VT_DM_BIN=$VTOY_PATH/tool/dmsetup
 733         fi
 734
 735         DM_VT_ID=$($VT_DM_BIN ls | $GREP ventoy | $SED 's/.*(\([0-9][0-9]*\),.*\([0-9][0-9]*\).*/\1 \2/')
 736         vtlog "DM_VT_ID=$DM_VT_ID ..."
 737         $BUSYBOX_PATH/mv "$1" $VTOY_PATH/dev_backup_${1#/dev/}
 738         $BUSYBOX_PATH/mknod -m 0666 "$1" b $DM_VT_ID
 739     fi
 740 }
 741
 742 # create link for device-mapper
 743 ventoy_create_persistent_link() {
 744     blkdev_num=$($VTOY_PATH/tool/dmsetup ls | grep vtoy_persistent | sed 's/.*(\([0-9][0-9]*\),.*\([0-9][0-9]*\).*/\1:\2/')
 745     vtDM=$(ventoy_find_dm_id ${blkdev_num})
 746
 747     if ! [ -d /dev/disk/by-label ]; then
 748         mkdir -p /dev/disk/by-label
 749     fi
 750
 751     VTLABEL=$($BUSYBOX_PATH/blkid /dev/$vtDM | $SED 's/.*LABEL="\([^"]*\)".*/\1/')
 752     if [ -z "$VTLABEL" ]; then
 753         VTLABEL=casper-rw
 754     fi
 755
 756     vtlog "Persistent Label: ##${VTLABEL}##"
 757
 758     if ! [ -e /dev/disk/by-label/$VTLABEL ]; then
 759         vtOldDir=$PWD
 760         cd /dev/disk/by-label
 761         ln -s ../../$vtDM $VTLABEL
 762         cd $vtOldDir
 763     fi
 764 }
 765
 766 ventoy_partname_to_diskname() {
 767     if echo $1 | $EGREP -q "nvme.*p[0-9]$|mmc.*p[0-9]$|nbd.*p[0-9]$"; then
 768         echo -n "${1:0:-2}"
 769     else
 770         echo -n "${1:0:-1}"
 771     fi
 772 }
 773
 774 ventoy_diskname_to_partname() {
 775     if echo $1 | $EGREP -q "nvme.*p[0-9]$|mmc.*p[0-9]$|nbd.*p[0-9]$"; then
 776         echo -n "${1}p$2"
 777     else
 778         echo -n "${1}$2"
 779     fi
 780 }
 781
 782 ventoy_udev_disk_common_hook() {
 783     if echo $1 | $EGREP -q "nvme.*p[0-9]$|mmc.*p[0-9]$|nbd.*p[0-9]$"; then
 784         VTDISK="${1:0:-2}"
 785     else
 786         VTDISK="${1:0:-1}"
 787     fi
 788
 789     if [ -e /vtoy/vtoy ]; then
 790         VTRWMOD=""
 791     else
 792         VTRWMOD="--readonly"
 793     fi
 794
 795     # create device mapper for iso image file
 796     if create_ventoy_device_mapper "/dev/$VTDISK" $VTRWMOD; then
 797         vtlog "==== create ventoy device mapper success ===="
 798     else
 799         vtlog "==== create ventoy device mapper failed ===="
 800
 801         $SLEEP 3
 802
 803         if $GREP -q "/dev/$VTDISK" /proc/mounts; then
 804             $GREP "/dev/$VTDISK" /proc/mounts | while read vtLine; do
 805                 vtPart=$(echo $vtLine | $AWK '{print $1}')
 806                 vtMnt=$(echo $vtLine | $AWK '{print $2}')
 807                 vtlog "$vtPart is mounted on $vtMnt  now umount it ..."
 808                 $BUSYBOX_PATH/umount $vtMnt
 809             done
 810         fi
 811
 812         if create_ventoy_device_mapper "/dev/$VTDISK" $VTRWMOD; then
 813             vtlog "==== create ventoy device mapper success after retry ===="
 814         else
 815             vtlog "==== create ventoy device mapper failed after retry ===="
 816             return
 817         fi
 818     fi
 819
 820     if [ "$2" = "noreplace" ]; then
 821         vtlog "no need to replace block device"
 822     else
 823         ventoy_copy_device_mapper "/dev/$1"
 824     fi
 825
 826     if [ -f $VTOY_PATH/ventoy_persistent_map ]; then
 827         create_persistent_device_mapper "/dev/$VTDISK"
 828         ventoy_create_persistent_link
 829     fi
 830
 831     if $GREP -q 'dm_patch' /proc/modules; then
 832         vtlog "remove dm_patch module."
 833         $BUSYBOX_PATH/rmmod dm_patch
 834     fi
 835 }
 836
 837 ventoy_create_dev_ventoy_part() {
 838     blkdev_num=$($VTOY_PATH/tool/dmsetup ls | $GREP ventoy | $SED 's/.*(\([0-9][0-9]*\),.*\([0-9][0-9]*\).*/\1 \2/')
 839     $BUSYBOX_PATH/mknod -m 0666 /dev/ventoy b $blkdev_num
 840
 841     if [ -e /vtoy_dm_table ]; then
 842         vtPartid=1
 843
 844         vtLevel1=$($CAT /proc/sys/kernel/printk | $AWK '{print $1}')
 845         vtLevel2=$($CAT /proc/sys/kernel/printk | $AWK '{print $2}')
 846         vtLevel3=$($CAT /proc/sys/kernel/printk | $AWK '{print $3}')
 847         vtLevel4=$($CAT /proc/sys/kernel/printk | $AWK '{print $4}')
 848         if [ -f $VTOY_PATH/dm_patch_done ]; then
 849             #suppress printk message
 850             echo 0 $vtLevel2 0 $vtLevel4 > /proc/sys/kernel/printk
 851         fi
 852
 853         $CAT /vtoy_dm_table | while read vtline; do
 854             echo $vtline > /ventoy/dm_table_part${vtPartid}
 855             $VTOY_PATH/tool/dmsetup create ventoy${vtPartid} /ventoy/dm_table_part${vtPartid}
 856
 857             blkdev_num=$($VTOY_PATH/tool/dmsetup ls | $GREP ventoy${vtPartid} | $SED 's/.*(\([0-9][0-9]*\),.*\([0-9][0-9]*\).*/\1 \2/')
 858             $BUSYBOX_PATH/mknod -m 0666 /dev/ventoy${vtPartid} b $blkdev_num
 859
 860             vtPartid=$(expr $vtPartid + 1)
 861         done
 862
 863         if [ -f $VTOY_PATH/dm_patch_done ]; then
 864             #recover printk level
 865             echo $vtLevel1 $vtLevel2 $vtLevel3 $vtLevel4 > /proc/sys/kernel/printk
 866         fi
 867     fi
 868 }
 869
 870
 871 ventoy_create_chromeos_ventoy_part() {
 872     blkdev_num=$($VTOY_PATH/tool/dmsetup ls | $GREP ventoy | $SED 's/.*(\([0-9][0-9]*\),.*\([0-9][0-9]*\).*/\1 \2/')
 873     $BUSYBOX_PATH/mknod -m 0666 /dev/ventoy b $blkdev_num
 874
 875     if [ -e /vtoy_dm_table ]; then
 876         vtPartid=1
 877
 878         $CAT /vtoy_dm_table | while read vtline; do
 879             echo $vtline > /ventoy/dm_table_part${vtPartid}
 880
 881             if [ $vtPartid -eq $1 ]; then
 882                 $VTOY_PATH/tool/dmsetup create ventoy${vtPartid} /ventoy/dm_table_part${vtPartid} --readonly
 883             else
 884                 $VTOY_PATH/tool/dmsetup create ventoy${vtPartid} /ventoy/dm_table_part${vtPartid}
 885             fi
 886
 887             blkdev_num=$($VTOY_PATH/tool/dmsetup ls | $GREP ventoy${vtPartid} | $SED 's/.*(\([0-9][0-9]*\),.*\([0-9][0-9]*\).*/\1 \2/')
 888             $BUSYBOX_PATH/mknod -m 0666 /dev/ventoy${vtPartid} b $blkdev_num
 889
 890             vtPartid=$(expr $vtPartid + 1)
 891         done
 892     fi
 893 }
 894
 895 is_inotify_ventoy_part() {
 896     if echo $1 | $GREP -q "2$"; then
 897         if ! [ -e /sys/block/$1 ]; then
 898             if [ -e /sys/class/block/$1 ]; then
 899                 if echo $1 | $EGREP -q "nvme|mmc|nbd"; then
 900                     vtShortName=${1:0:-2}
 901                 else
 902                     vtShortName=${1:0:-1}
 903                 fi
 904
 905                 if [ -e /dev/$vtShortName ]; then
 906                     if [ "$VTOY_VLNK_BOOT" = "01" ]; then
 907                         vtOrgDiskName=$($VTOY_PATH/tool/vtoydump -t $VTOY_PATH/ventoy_os_param)
 908                         [ "$vtOrgDiskName" = "/dev/$vtShortName" ]
 909                     else
 910                         $VTOY_PATH/tool/vtoydump -f $VTOY_PATH/ventoy_os_param -c $vtShortName
 911                     fi
 912                     return
 913                 fi
 914             fi
 915         fi
 916     fi
 917
 918     [ "1" = "0" ]
 919 }
 920
 921 ventoy_find_dm_id() {
 922     for vt in $($BUSYBOX_PATH/ls /sys/block/); do
 923         if [ "${vt:0:3}" = "dm-" ]; then
 924             vtMajorMinor=$($CAT /sys/block/$vt/dev)
 925             if [ "$vtMajorMinor" = "$1" ]; then
 926                 echo ${vt}
 927                 return
 928             fi
 929         fi
 930     done
 931     echo 'xx'
 932 }
 933
 934 ventoy_swap_device() {
 935     mv $1 $VTOY_PATH/swap_tmp_dev
 936     mv $2 $1
 937     mv $VTOY_PATH/swap_tmp_dev $2
 938 }
 939
 940 ventoy_extract_vtloopex() {
 941     vtCurPwd=$PWD
 942     $BUSYBOX_PATH/mkdir -p $VTOY_PATH/partmnt $VTOY_PATH/vtloopex
 943     $BUSYBOX_PATH/mount -o ro -t vfat $1  $VTOY_PATH/partmnt
 944     cd $VTOY_PATH/vtloopex
 945     $CAT $VTOY_PATH/partmnt/ventoy/vtloopex.cpio | $BUSYBOX_PATH/cpio -idm >> $VTLOG 2>&1
 946     $BUSYBOX_PATH/umount $VTOY_PATH/partmnt
 947     $BUSYBOX_PATH/rm -rf $VTOY_PATH/partmnt
 948
 949     if [ -n "$2" ]; then
 950         cd $VTOY_PATH/vtloopex/$2/
 951         $BUSYBOX_PATH/tar -xJf vtloopex.tar.xz
 952     fi
 953
 954     cd $vtCurPwd
 955 }
 956
 957 ventoy_check_install_module_xz() {
 958     if [ -f "${1}.xz" ]; then
 959         $BUSYBOX_PATH/xz -d  "${1}.xz"
 960         $BUSYBOX_PATH/insmod "$1"
 961     fi
 962 }
 963
 964 ventoy_check_umount() {
 965     for vtLoop in 0 1 2 3 4 5 6 7 8 9; do
 966         $BUSYBOX_PATH/umount "$1" > /dev/null 2>&1
 967         if $BUSYBOX_PATH/mountpoint -q "$1"; then
 968             $SLEEP 1
 969         else
 970             break
 971         fi
 972     done
 973 }
 974
 975 ventoy_wait_dir() {
 976     vtdir=$1
 977     vtsec=0
 978
 979     while [ $vtsec -lt $2 ]; do
 980         if [ -d "$vtdir" ]; then
 981             break
 982         else
 983             $SLEEP 1
 984             vtsec=$(expr $vtsec + 1)
 985         fi
 986     done
 987 }