package/base-files/files/lib/functions/caldata.sh

   1 # Copyright (C) 2019 OpenWrt.org
   2
   3 . /lib/functions.sh
   4 . /lib/functions/system.sh
   5
   6 caldata_die() {
   7         echo "caldata: " "$*"
   8         exit 1
   9 }
  10
  11 caldata_extract() {
  12         local part=$1
  13         local offset=$(($2))
  14         local count=$(($3))
  15         local mtd
  16
  17         mtd=$(find_mtd_chardev $part)
  18         [ -n "$mtd" ] || caldata_die "no mtd device found for partition $part"
  19
  20         dd if=$mtd of=/lib/firmware/$FIRMWARE iflag=skip_bytes bs=$count skip=$offset count=1 2>/dev/null || \
  21                 caldata_die "failed to extract calibration data from $mtd"
  22 }
  23
  24 caldata_extract_ubi() {
  25         local part=$1
  26         local offset=$(($2))
  27         local count=$(($3))
  28         local ubidev
  29         local ubi
  30
  31         . /lib/upgrade/nand.sh
  32
  33         ubidev=$(nand_find_ubi $CI_UBIPART)
  34         ubi=$(nand_find_volume $ubidev $part)
  35         [ -n "$ubi" ] || caldata_die "no UBI volume found for $part"
  36
  37         dd if=/dev/$ubi of=/lib/firmware/$FIRMWARE iflag=skip_bytes bs=$count skip=$offset count=1 2>/dev/null || \
  38                 caldata_die "failed to extract calibration data from $ubi"
  39 }
  40
  41 caldata_extract_reverse() {
  42         local part=$1
  43         local offset=$2
  44         local count=$(($3))
  45         local mtd
  46         local reversed
  47         local caldata
  48
  49         mtd=$(find_mtd_chardev "$part")
  50         reversed=$(hexdump -v -s $offset -n $count -e '/1 "%02x "' $mtd)
  51
  52         for byte in $reversed; do
  53                 caldata="\x${byte}${caldata}"
  54         done
  55
  56         printf "%b" "$caldata" > /lib/firmware/$FIRMWARE
  57 }
  58
  59 caldata_from_file() {
  60         local source=$1
  61         local offset=$(($2))
  62         local count=$(($3))
  63         local target=$4
  64
  65         [ -n "$target" ] || target=/lib/firmware/$FIRMWARE
  66
  67         dd if=$source of=$target iflag=skip_bytes bs=$count skip=$offset count=1 2>/dev/null || \
  68                 caldata_die "failed to extract calibration data from $source"
  69 }
  70
  71 caldata_sysfsload_from_file() {
  72         local source=$1
  73         local offset=$(($2))
  74         local count=$(($3))
  75
  76         # test extract to /dev/null first
  77         dd if=$source of=/dev/null iflag=skip_bytes bs=$count skip=$offset count=1 2>/dev/null || \
  78                 caldata_die "failed to extract calibration data from $source"
  79
  80         # can't fail now
  81         echo 1 > /sys/$DEVPATH/loading
  82         dd if=$source of=/sys/$DEVPATH/data iflag=skip_bytes bs=$count skip=$offset count=1 2>/dev/null
  83         echo 0 > /sys/$DEVPATH/loading
  84 }
  85
  86 caldata_valid() {
  87         local expected="$1"
  88         local target=$2
  89
  90         [ -n "$target" ] || target=/lib/firmware/$FIRMWARE
  91
  92         magic=$(hexdump -v -n 2 -e '1/1 "%02x"' $target)
  93         [ "$magic" = "$expected" ]
  94         return $?
  95 }
  96
  97 caldata_patch_chksum() {
  98         local mac=$1
  99         local mac_offset=$(($2))
 100         local chksum_offset=$(($3))
 101         local target=$4
 102         local xor_mac
 103         local xor_fw_mac
 104         local xor_fw_chksum
 105
 106         xor_mac=${mac//:/}
 107         xor_mac="${xor_mac:0:4} ${xor_mac:4:4} ${xor_mac:8:4}"
 108
 109         xor_fw_mac=$(hexdump -v -n 6 -s $mac_offset -e '/1 "%02x"' /lib/firmware/$FIRMWARE)
 110         xor_fw_mac="${xor_fw_mac:0:4} ${xor_fw_mac:4:4} ${xor_fw_mac:8:4}"
 111
 112         xor_fw_chksum=$(hexdump -v -n 2 -s $chksum_offset -e '/1 "%02x"' /lib/firmware/$FIRMWARE)
 113         xor_fw_chksum=$(xor $xor_fw_chksum $xor_fw_mac $xor_mac)
 114
 115         printf "%b" "\x${xor_fw_chksum:0:2}\x${xor_fw_chksum:2:2}" | \
 116                 dd of=$target conv=notrunc bs=1 seek=$chksum_offset count=2
 117 }
 118
 119 caldata_patch_mac() {
 120         local mac=$1
 121         local mac_offset=$(($2))
 122         local chksum_offset=$3
 123         local target=$4
 124
 125         [ -z "$mac" -o -z "$mac_offset" ] && return
 126
 127         [ -n "$target" ] || target=/lib/firmware/$FIRMWARE
 128
 129         [ -n "$chksum_offset" ] && caldata_patch_chksum "$mac" "$mac_offset" "$chksum_offset" "$target"
 130
 131         macaddr_2bin $mac | dd of=$target conv=notrunc oflag=seek_bytes bs=6 seek=$mac_offset count=1 || \
 132                 caldata_die "failed to write MAC address to eeprom file"
 133 }
 134
 135 ath9k_patch_mac() {
 136         local mac=$1
 137         local target=$2
 138
 139         caldata_patch_mac "$mac" 0x2 "" "$target"
 140 }
 141
 142 ath9k_patch_mac_crc() {
 143         local mac=$1
 144         local mac_offset=$2
 145         local chksum_offset=$((mac_offset - 10))
 146         local target=$4
 147
 148         caldata_patch_mac "$mac" "$mac_offset" "$chksum_offset" "$target"
 149 }
 150
 151 ath10k_patch_mac() {
 152         local mac=$1
 153         local target=$2
 154
 155         caldata_patch_mac "$mac" 0x6 0x2 "$target"
 156 }