1#!/bin/bash 2# SPDX-License-Identifier: GPL-2.0 3# Copyright 2021-2022 NXP 4 5# Note: On LS1028A, in lack of enough user ports, this setup requires patching 6# the device tree to use the second CPU port as a user port 7 8WAIT_TIME=1 9NUM_NETIFS=4 10STABLE_MAC_ADDRS=yes 11NETIF_CREATE=no 12lib_dir=$(dirname $0)/../../../net/forwarding 13source $lib_dir/tc_common.sh 14source $lib_dir/lib.sh 15source $lib_dir/tsn_lib.sh 16 17UDS_ADDRESS_H1="/var/run/ptp4l_h1" 18UDS_ADDRESS_SWP1="/var/run/ptp4l_swp1" 19 20# Tunables 21NUM_PKTS=1000 22STREAM_VID=100 23STREAM_PRIO=6 24# Use a conservative cycle of 10 ms to allow the test to still pass when the 25# kernel has some extra overhead like lockdep etc 26CYCLE_TIME_NS=10000000 27# Create two Gate Control List entries, one OPEN and one CLOSE, of equal 28# durations 29GATE_DURATION_NS=$((${CYCLE_TIME_NS} / 2)) 30# Give 2/3 of the cycle time to user space and 1/3 to the kernel 31FUDGE_FACTOR=$((${CYCLE_TIME_NS} / 3)) 32# Shift the isochron base time by half the gate time, so that packets are 33# always received by swp1 close to the middle of the time slot, to minimize 34# inaccuracies due to network sync 35SHIFT_TIME_NS=$((${GATE_DURATION_NS} / 2)) 36 37h1=${NETIFS[p1]} 38swp1=${NETIFS[p2]} 39swp2=${NETIFS[p3]} 40h2=${NETIFS[p4]} 41 42H1_IPV4="192.0.2.1" 43H2_IPV4="192.0.2.2" 44H1_IPV6="2001:db8:1::1" 45H2_IPV6="2001:db8:1::2" 46 47# Chain number exported by the ocelot driver for 48# Per-Stream Filtering and Policing filters 49PSFP() 50{ 51 echo 30000 52} 53 54psfp_chain_create() 55{ 56 local if_name=$1 57 58 tc qdisc add dev $if_name clsact 59 60 tc filter add dev $if_name ingress chain 0 pref 49152 flower \ 61 skip_sw action goto chain $(PSFP) 62} 63 64psfp_chain_destroy() 65{ 66 local if_name=$1 67 68 tc qdisc del dev $if_name clsact 69} 70 71psfp_filter_check() 72{ 73 local expected=$1 74 local packets="" 75 local drops="" 76 local stats="" 77 78 stats=$(tc -j -s filter show dev ${swp1} ingress chain $(PSFP) pref 1) 79 packets=$(echo ${stats} | jq ".[1].options.actions[].stats.packets") 80 drops=$(echo ${stats} | jq ".[1].options.actions[].stats.drops") 81 82 if ! [ "${packets}" = "${expected}" ]; then 83 printf "Expected filter to match on %d packets but matched on %d instead\n" \ 84 "${expected}" "${packets}" 85 fi 86 87 echo "Hardware filter reports ${drops} drops" 88} 89 90h1_create() 91{ 92 simple_if_init $h1 $H1_IPV4/24 $H1_IPV6/64 93} 94 95h1_destroy() 96{ 97 simple_if_fini $h1 $H1_IPV4/24 $H1_IPV6/64 98} 99 100h2_create() 101{ 102 simple_if_init $h2 $H2_IPV4/24 $H2_IPV6/64 103} 104 105h2_destroy() 106{ 107 simple_if_fini $h2 $H2_IPV4/24 $H2_IPV6/64 108} 109 110switch_create() 111{ 112 local h2_mac_addr=$(mac_get $h2) 113 114 ip link set ${swp1} up 115 ip link set ${swp2} up 116 117 ip link add br0 type bridge vlan_filtering 1 118 ip link set ${swp1} master br0 119 ip link set ${swp2} master br0 120 ip link set br0 up 121 122 bridge vlan add dev ${swp2} vid ${STREAM_VID} 123 bridge vlan add dev ${swp1} vid ${STREAM_VID} 124 # PSFP on Ocelot requires the filter to also be added to the bridge 125 # FDB, and not be removed 126 bridge fdb add dev ${swp2} \ 127 ${h2_mac_addr} vlan ${STREAM_VID} static master 128 129 psfp_chain_create ${swp1} 130 131 tc filter add dev ${swp1} ingress chain $(PSFP) pref 1 \ 132 protocol 802.1Q flower skip_sw \ 133 dst_mac ${h2_mac_addr} vlan_id ${STREAM_VID} \ 134 action gate base-time 0.000000000 \ 135 sched-entry OPEN ${GATE_DURATION_NS} -1 -1 \ 136 sched-entry CLOSE ${GATE_DURATION_NS} -1 -1 137} 138 139switch_destroy() 140{ 141 psfp_chain_destroy ${swp1} 142 ip link del br0 143} 144 145txtime_setup() 146{ 147 local if_name=$1 148 149 tc qdisc add dev ${if_name} clsact 150 # Classify PTP on TC 7 and isochron on TC 6 151 tc filter add dev ${if_name} egress protocol 0x88f7 \ 152 flower action skbedit priority 7 153 tc filter add dev ${if_name} egress protocol 802.1Q \ 154 flower vlan_ethtype 0xdead action skbedit priority 6 155 tc qdisc add dev ${if_name} handle 100: parent root mqprio num_tc 8 \ 156 queues 1@0 1@1 1@2 1@3 1@4 1@5 1@6 1@7 \ 157 map 0 1 2 3 4 5 6 7 \ 158 hw 1 159 # Set up TC 6 for SO_TXTIME. tc-mqprio queues count from 1. 160 tc qdisc replace dev ${if_name} parent 100:$((${STREAM_PRIO} + 1)) etf \ 161 clockid CLOCK_TAI offload delta ${FUDGE_FACTOR} 162} 163 164txtime_cleanup() 165{ 166 local if_name=$1 167 168 tc qdisc del dev ${if_name} root 169 tc qdisc del dev ${if_name} clsact 170} 171 172setup_prepare() 173{ 174 vrf_prepare 175 176 h1_create 177 h2_create 178 switch_create 179 180 txtime_setup ${h1} 181 182 # Set up swp1 as a master PHC for h1, synchronized to the local 183 # CLOCK_REALTIME. 184 phc2sys_start ${UDS_ADDRESS_SWP1} 185 186 # Assumption true for LS1028A: h1 and h2 use the same PHC. So by 187 # synchronizing h1 to swp1 via PTP, h2 is also implicitly synchronized 188 # to swp1 (and both to CLOCK_REALTIME). 189 ptp4l_start ${h1} true ${UDS_ADDRESS_H1} 190 ptp4l_start ${swp1} false ${UDS_ADDRESS_SWP1} 191 192 # Make sure there are no filter matches at the beginning of the test 193 psfp_filter_check 0 194} 195 196cleanup() 197{ 198 pre_cleanup 199 200 ptp4l_stop ${swp1} 201 ptp4l_stop ${h1} 202 phc2sys_stop 203 isochron_recv_stop 204 205 txtime_cleanup ${h1} 206 207 h2_destroy 208 h1_destroy 209 switch_destroy 210 211 vrf_cleanup 212} 213 214debug_incorrectly_dropped_packets() 215{ 216 local isochron_dat=$1 217 local dropped_seqids 218 local seqid 219 220 echo "Packets incorrectly dropped:" 221 222 dropped_seqids=$(isochron report \ 223 --input-file "${isochron_dat}" \ 224 --printf-format "%u RX hw %T\n" \ 225 --printf-args "qR" | \ 226 grep 'RX hw 0.000000000' | \ 227 awk '{print $1}') 228 229 for seqid in ${dropped_seqids}; do 230 isochron report \ 231 --input-file "${isochron_dat}" \ 232 --start ${seqid} --stop ${seqid} \ 233 --printf-format "seqid %u scheduled for %T, HW TX timestamp %T\n" \ 234 --printf-args "qST" 235 done 236} 237 238debug_incorrectly_received_packets() 239{ 240 local isochron_dat=$1 241 242 echo "Packets incorrectly received:" 243 244 isochron report \ 245 --input-file "${isochron_dat}" \ 246 --printf-format "seqid %u scheduled for %T, HW TX timestamp %T, HW RX timestamp %T\n" \ 247 --printf-args "qSTR" | 248 grep -v 'HW RX timestamp 0.000000000' 249} 250 251run_test() 252{ 253 local base_time=$1 254 local expected=$2 255 local test_name=$3 256 local debug=$4 257 local isochron_dat="$(mktemp)" 258 local extra_args="" 259 local received 260 261 isochron_do \ 262 "${h1}" \ 263 "${h2}" \ 264 "${UDS_ADDRESS_H1}" \ 265 "" \ 266 "${base_time}" \ 267 "${CYCLE_TIME_NS}" \ 268 "${SHIFT_TIME_NS}" \ 269 "${NUM_PKTS}" \ 270 "${STREAM_VID}" \ 271 "${STREAM_PRIO}" \ 272 "" \ 273 "${isochron_dat}" 274 275 # Count all received packets by looking at the non-zero RX timestamps 276 received=$(isochron report \ 277 --input-file "${isochron_dat}" \ 278 --printf-format "%u\n" --printf-args "R" | \ 279 grep -w -v '0' | wc -l) 280 281 if [ "${received}" = "${expected}" ]; then 282 RET=0 283 else 284 RET=1 285 echo "Expected isochron to receive ${expected} packets but received ${received}" 286 fi 287 288 log_test "${test_name}" 289 290 if [ "$RET" = "1" ]; then 291 ${debug} "${isochron_dat}" 292 fi 293 294 rm ${isochron_dat} 2> /dev/null 295} 296 297test_gate_in_band() 298{ 299 # Send packets in-band with the OPEN gate entry 300 run_test 0.000000000 ${NUM_PKTS} "In band" \ 301 debug_incorrectly_dropped_packets 302 303 psfp_filter_check ${NUM_PKTS} 304} 305 306test_gate_out_of_band() 307{ 308 # Send packets in-band with the CLOSE gate entry 309 run_test 0.005000000 0 "Out of band" \ 310 debug_incorrectly_received_packets 311 312 psfp_filter_check $((2 * ${NUM_PKTS})) 313} 314 315trap cleanup EXIT 316 317ALL_TESTS=" 318 test_gate_in_band 319 test_gate_out_of_band 320" 321 322setup_prepare 323setup_wait 324 325tests_run 326 327exit $EXIT_STATUS 328