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_mmc() {
  52         local part=$1
  53         local offset=$(($2))
  54         local count=$(($3))
  55         local mmc_part
  56
  57         mmc_part=$(find_mmc_part $part)
  58         [ -n "$mmc_part" ] || caldata_die "no mmc partition found for partition $part"
  59
  60         caldata_dd $mmc_part /lib/firmware/$FIRMWARE $count $offset || \
  61                 caldata_die "failed to extract calibration data from $mmc_part"
  62 }
  63
  64 caldata_extract_reverse() {
  65         local part=$1
  66         local offset=$2
  67         local count=$(($3))
  68         local mtd
  69         local reversed
  70         local caldata
  71
  72         mtd=$(find_mtd_chardev "$part")
  73         reversed=$(hexdump -v -s $offset -n $count -e '/1 "%02x "' $mtd)
  74
  75         for byte in $reversed; do
  76                 caldata="\x${byte}${caldata}"
  77         done
  78
  79         printf "%b" "$caldata" > /lib/firmware/$FIRMWARE
  80 }
  81
  82 caldata_from_file() {
  83         local source=$1
  84         local offset=$(($2))
  85         local count=$(($3))
  86         local target=$4
  87
  88         [ -n "$target" ] || target=/lib/firmware/$FIRMWARE
  89
  90         caldata_dd $source $target $count $offset || \
  91                 caldata_die "failed to extract calibration data from $source"
  92 }
  93
  94 caldata_sysfsload_from_file() {
  95         local source=$1
  96         local offset=$(($2))
  97         local count=$(($3))
  98         local target_dir="/sys/$DEVPATH"
  99         local target="$target_dir/data"
 100
 101         [ -d "$target_dir" ] || \
 102                 caldata_die "no sysfs dir to write: $target"
 103
 104         echo 1 > "$target_dir/loading"
 105         caldata_dd $source $target $count $offset
 106         if [ $? != 0 ]; then
 107                 echo 1 > "$target_dir/loading"
 108                 caldata_die "failed to extract calibration data from $source"
 109         else
 110                 echo 0 > "$target_dir/loading"
 111         fi
 112 }
 113
 114 caldata_valid() {
 115         local expected="$1"
 116         local target=$2
 117
 118         [ -n "$target" ] || target=/lib/firmware/$FIRMWARE
 119
 120         magic=$(hexdump -v -n 2 -e '1/1 "%02x"' $target)
 121         [ "$magic" = "$expected" ]
 122         return $?
 123 }
 124
 125 caldata_patch_chksum() {
 126         local mac=$1
 127         local mac_offset=$(($2))
 128         local chksum_offset=$(($3))
 129         local target=$4
 130         local xor_mac
 131         local xor_fw_mac
 132         local xor_fw_chksum
 133
 134         xor_mac=${mac//:/}
 135         xor_mac="${xor_mac:0:4} ${xor_mac:4:4} ${xor_mac:8:4}"
 136
 137         xor_fw_mac=$(hexdump -v -n 6 -s $mac_offset -e '/1 "%02x"' /lib/firmware/$FIRMWARE)
 138         xor_fw_mac="${xor_fw_mac:0:4} ${xor_fw_mac:4:4} ${xor_fw_mac:8:4}"
 139
 140         xor_fw_chksum=$(hexdump -v -n 2 -s $chksum_offset -e '/1 "%02x"' /lib/firmware/$FIRMWARE)
 141         xor_fw_chksum=$(xor $xor_fw_chksum $xor_fw_mac $xor_mac)
 142
 143         printf "%b" "\x${xor_fw_chksum:0:2}\x${xor_fw_chksum:2:2}" | \
 144                 dd of=$target conv=notrunc bs=1 seek=$chksum_offset count=2
 145 }
 146
 147 caldata_patch_mac() {
 148         local mac=$1
 149         local mac_offset=$(($2))
 150         local chksum_offset=$3
 151         local target=$4
 152
 153         [ -z "$mac" -o -z "$mac_offset" ] && return
 154
 155         [ -n "$target" ] || target=/lib/firmware/$FIRMWARE
 156
 157         [ -n "$chksum_offset" ] && caldata_patch_chksum "$mac" "$mac_offset" "$chksum_offset" "$target"
 158
 159         macaddr_2bin $mac | dd of=$target conv=notrunc oflag=seek_bytes bs=6 seek=$mac_offset count=1 || \
 160                 caldata_die "failed to write MAC address to eeprom file"
 161 }
 162
 163 ath9k_patch_mac() {
 164         local mac=$1
 165         local target=$2
 166
 167         caldata_patch_mac "$mac" 0x2 "" "$target"
 168 }
 169
 170 ath9k_patch_mac_crc() {
 171         local mac=$1
 172         local mac_offset=$2
 173         local chksum_offset=$((mac_offset - 10))
 174         local target=$4
 175
 176         caldata_patch_mac "$mac" "$mac_offset" "$chksum_offset" "$target"
 177 }
 178
 179 ath10k_patch_mac() {
 180         local mac=$1
 181         local target=$2
 182
 183         caldata_patch_mac "$mac" 0x6 0x2 "$target"
 184 }