004bcfa9906bae3967d3a437c2fcc24979e9d50a
[openwrt/.git] / 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
64         dd if=$source of=/lib/firmware/$FIRMWARE iflag=skip_bytes bs=$count skip=$offset count=1 2>/dev/null || \
65                 caldata_die "failed to extract calibration data from $source"
66 }
67
68 caldata_valid() {
69         local expected="$1"
70
71         magic=$(hexdump -v -n 2 -e '1/1 "%02x"' /lib/firmware/$FIRMWARE)
72         [[ "$magic" == "$expected" ]]
73         return $?
74 }
75
76 caldata_patch_chksum() {
77         local mac=$1
78         local mac_offset=$(($2))
79         local chksum_offset=$(($3))
80         local xor_mac
81         local xor_fw_mac
82         local xor_fw_chksum
83
84         xor_mac=${mac//:/}
85         xor_mac="${xor_mac:0:4} ${xor_mac:4:4} ${xor_mac:8:4}"
86
87         xor_fw_mac=$(hexdump -v -n 6 -s $mac_offset -e '/1 "%02x"' /lib/firmware/$FIRMWARE)
88         xor_fw_mac="${xor_fw_mac:0:4} ${xor_fw_mac:4:4} ${xor_fw_mac:8:4}"
89
90         xor_fw_chksum=$(hexdump -v -n 2 -s $chksum_offset -e '/1 "%02x"' /lib/firmware/$FIRMWARE)
91         xor_fw_chksum=$(xor $xor_fw_chksum $xor_fw_mac $xor_mac)
92
93         printf "%b" "\x${xor_fw_chksum:0:2}\x${xor_fw_chksum:2:2}" | \
94                 dd of=/lib/firmware/$FIRMWARE conv=notrunc bs=1 seek=$chksum_offset count=2
95 }
96
97 caldata_patch_mac() {
98         local mac=$1
99         local mac_offset=$(($2))
100         local chksum_offset=$3
101
102         [ -z "$mac" -o -z "$mac_offset" ] && return
103
104         [ -n "$chksum_offset" ] && caldata_patch_chksum "$mac" "$mac_offset" "$chksum_offset"
105
106         macaddr_2bin $mac | dd of=/lib/firmware/$FIRMWARE conv=notrunc oflag=seek_bytes bs=6 seek=$mac_offset count=1 || \
107                 caldata_die "failed to write MAC address to eeprom file"
108 }
109
110 ath9k_patch_mac() {
111         local mac=$1
112
113         caldata_patch_mac "$mac" 0x2
114 }
115
116 ath9k_patch_mac_crc() {
117         local mac=$1
118         local mac_offset=$2
119         local chksum_offset=$((mac_offset - 10))
120
121         caldata_patch_mac "$mac" "$mac_offset" "$chksum_offset"
122 }
123
124 ath10kcal_patch_mac() {
125         local mac=$1
126
127         caldata_patch_mac "$mac" 0x6
128 }
129
130 ath10kcal_patch_mac_crc() {
131         local mac=$1
132
133         caldata_patch_mac "$mac" 0x6 0x2
134 }