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