meta-bletchley: Introduce mdio-util
Introduce a MDIO Utility for AST2600
Signed-off-by: Potin Lai <potin.lai@quantatw.com>
Change-Id: Ia94078be73f2af443f745c7797111d9d94e8047b
diff --git a/meta-facebook/meta-bletchley/recipes-bletchley/mdio-util/files/mdio-util b/meta-facebook/meta-bletchley/recipes-bletchley/mdio-util/files/mdio-util
new file mode 100644
index 0000000..5a5ff63
--- /dev/null
+++ b/meta-facebook/meta-bletchley/recipes-bletchley/mdio-util/files/mdio-util
@@ -0,0 +1,214 @@
+#!/bin/bash
+#
+# mdio-util - MDIO Utility for AST2600
+#
+# This shell script provides the ability to access MDIO bus over devmem
+#
+# TODO: A read/write action contains multiple MDIO operations, it needs a
+# lock to protect entire action.
+
+
+RETRY_CNT=30
+RETRY_DEALY_SEC="0.1"
+
+MDIO_BASE_REG=$((16#1e650000))
+C22_READ_CMD=$((16#98000000))
+C22_WRITE_CMD=$((16#94000000))
+
+C45_ADDR_CMD=$((16#80000000))
+C45_WRITE_CMD=$((16#84000000))
+C45_PREAD_CMD=$((16#88000000))
+C45_READ_CMD=$((16#8C000000))
+
+PHY_ADDR_STEP=$((16#200000))
+DEV_ADDR_STEP=$((16#10000))
+REG_ADDR_STEP=$((16#10000))
+
+aspeed_mdio_c22_read() {
+ BUS=$1
+ PHY_ADDR=$2
+ REG_ADDR=$3
+
+ MDIO_CTRL_REG=$((MDIO_BASE_REG+BUS*8))
+ MDIO_DATA_REG=$((MDIO_CTRL_REG+4))
+
+ CMD=$((C22_READ_CMD+PHY_ADDR*PHY_ADDR_STEP+REG_ADDR*REG_ADDR_STEP))
+
+ # write control register
+ devmem $MDIO_CTRL_REG 32 $CMD
+ for i in $(seq 1 1 $RETRY_CNT)
+ do
+ CHECK_STR=$(devmem $MDIO_CTRL_REG)
+ CHECK_VAL=$((16#${CHECK_STR#"0x"}))
+ if [ $((CHECK_VAL&16#80000000)) -eq 0 ]; then
+ break
+ elif [ "$i" -eq "${RETRY_CNT}" ]; then
+ echo "[c22] read operation timeout"
+ return 1
+ fi
+ sleep "$RETRY_DEALY_SEC"
+ done
+
+ # read data register
+ for i in $(seq 1 1 $RETRY_CNT)
+ do
+ DATA_STR=$(devmem $MDIO_DATA_REG)
+ DATA_VAL=$((16#${DATA_STR#"0x"}))
+ if [ $((DATA_VAL&16#00010000)) -ne 0 ]; then
+ DATA_VAL=$((DATA_VAL&16#0000FFFF))
+ echo "0x$(printf %04x $DATA_VAL)"
+ break
+ elif [ "$i" -eq "$RETRY_CNT" ]; then
+ echo "[c22] read data timeout"
+ return 1
+ fi
+ sleep "$RETRY_DEALY_SEC"
+ done
+
+ return 0
+}
+
+aspeed_mdio_c22_write() {
+ BUS=$1
+ PHY_ADDR=$2
+ REG_ADDR=$3
+ WR_DATA=$4
+
+ MDIO_CTRL_REG=$((MDIO_BASE_REG+BUS*8))
+ MDIO_DATA_REG=$((MDIO_CTRL_REG+4))
+ CMD=$((C22_WRITE_CMD+PHY_ADDR*PHY_ADDR_STEP+REG_ADDR*REG_ADDR_STEP+WR_DATA))
+
+ # write control register
+ devmem $MDIO_CTRL_REG 32 $CMD
+ for i in $(seq 1 1 $RETRY_CNT)
+ do
+ CHECK_STR=$(devmem $MDIO_CTRL_REG)
+ CHECK_VAL=$((16#${CHECK_STR#"0x"}))
+ if [ $((CHECK_VAL&16#80000000)) -eq 0 ]; then
+ break
+ elif [ "$i" -eq "$RETRY_CNT" ]; then
+ echo "[c22] write operation timeout"
+ return 1
+ fi
+ sleep "$RETRY_DEALY_SEC"
+ done
+
+ return 0
+}
+
+aspeed_mdio_c45_ctrl() {
+ BUS=$1
+ C45_OP=$2
+ PHY_ADDR=$3
+ DEV_ADDR=$4
+ CMD_DATA=$5
+
+ MDIO_CTRL_REG=$((MDIO_BASE_REG+BUS*8))
+
+ case "$C45_OP" in
+ 0)
+ CMD=$C45_ADDR_CMD
+ ;;
+ 1)
+ CMD=$C45_WRITE_CMD
+ ;;
+ 2)
+ CMD=$C45_PREAD_CMD
+ ;;
+ 3)
+ CMD=$C45_READ_CMD
+ ;;
+ *)
+ echo "[c45] unknow operator $C45_OP"
+ return 1
+ ;;
+ esac
+
+ CMD=$((CMD+PHY_ADDR*PHY_ADDR_STEP+DEV_ADDR*DEV_ADDR_STEP+CMD_DATA))
+
+ # write control register
+ devmem $MDIO_CTRL_REG 32 $CMD
+ for i in $(seq 1 1 $RETRY_CNT)
+ do
+ CHECK_STR=$(devmem $MDIO_CTRL_REG)
+ CHECK_VAL=$((16#${CHECK_STR#"0x"}))
+ if [ $((CHECK_VAL&16#80000000)) -eq 0 ]; then
+ break
+ elif [ "$i" -eq "$RETRY_CNT" ]; then
+ echo "[c45] operation timeout, op: $C45_OP"
+ return 1
+ fi
+ sleep "$RETRY_DEALY_SEC"
+ done
+
+ return 0
+}
+
+aspeed_mdio_c45_data() {
+ BUS=$1
+ PHY_ADDR=$2
+ DEV_ADDR=$3
+
+ MDIO_CTRL_REG=$((MDIO_BASE_REG+BUS*8))
+ MDIO_DATA_REG=$((MDIO_CTRL_REG+4))
+
+ # read data register
+ for i in $(seq 1 1 $RETRY_CNT)
+ do
+ DATA_STR=$(devmem $MDIO_DATA_REG)
+ DATA_VAL=$((16#${DATA_STR#"0x"}))
+ if [ $((DATA_VAL&16#00010000)) -ne 0 ]; then
+ DATA_VAL=$((DATA_VAL&16#0000FFFF))
+ echo "0x$(printf %04x $DATA_VAL)"
+ break
+ elif [ "$i" -eq "$RETRY_CNT" ]; then
+ echo "[c45] read data timeout"
+ return 1
+ fi
+ sleep "$RETRY_DEALY_SEC"
+ done
+
+ return 0
+}
+
+print_usage() {
+ echo "Usage:"
+ echo " [clause 22]"
+ echo " $0 c22 r <BUS> <PHY_ADDR> <REG_ADDR>"
+ echo " $0 c22 w <BUS> <PHY_ADDR> <REG_ADDR> <DATA>"
+ echo " [clause 45]"
+ echo " $0 c45 r <BUS> <PHY_ADDR> <DEV_ADDR> <REG_ADDR>"
+ echo " $0 c45 w <BUS> <PHY_ADDR> <DEV_ADDR> <REG_ADDR> <DATA>"
+}
+
+CLAUSE_VER=${1}
+CMD_TYPE=${2}
+BUS=$3
+PHY_ADDR=$4
+
+if [ ! -c /dev/mem ]; then
+ mknod /dev/mem c 1 1
+fi
+
+if [ "$CLAUSE_VER" == "c22" ] && [ "$CMD_TYPE" == "r" ] && [ "$#" -eq 5 ]; then
+ REG_ADDR=${5}
+ aspeed_mdio_c22_read "$BUS" "$PHY_ADDR" "$REG_ADDR" || exit 1
+elif [ "$CLAUSE_VER" == "c22" ] && [ "$CMD_TYPE" == "w" ] && [ "$#" -eq 6 ]; then
+ REG_ADDR=${5}
+ DATA=${6}
+ aspeed_mdio_c22_write "$BUS" "$PHY_ADDR $REG_ADDR $DATA" || exit 1
+elif [ "$CLAUSE_VER" == "c45" ] && [ "$CMD_TYPE" == "r" ] && [ "$#" -eq 6 ]; then
+ DEV_ADDR=${5}
+ REG_ADDR=${6}
+ aspeed_mdio_c45_ctrl "$BUS" 0 "$PHY_ADDR" "$DEV_ADDR" "$REG_ADDR" || exit 1
+ aspeed_mdio_c45_ctrl "$BUS" 3 "$PHY_ADDR" "$DEV_ADDR" "$REG_ADDR" || exit 1
+ aspeed_mdio_c45_data "$BUS" "$PHY_ADDR" "$DEV_ADDR" || exit 1
+elif [ "$CLAUSE_VER" == "c45" ] && [ "$CMD_TYPE" == "w" ] && [ "$#" -eq 7 ]; then
+ DEV_ADDR=${5}
+ REG_ADDR=${6}
+ DATA=${7}
+ aspeed_mdio_c45_ctrl "$BUS" 0 "$PHY_ADDR" "$DEV_ADDR" "$REG_ADDR" || exit 1
+ aspeed_mdio_c45_ctrl "$BUS" 1 "$PHY_ADDR" "$DEV_ADDR" "$DATA" || exit 1
+else
+ print_usage
+fi
diff --git a/meta-facebook/meta-bletchley/recipes-bletchley/mdio-util/mdio-util_0.1.bb b/meta-facebook/meta-bletchley/recipes-bletchley/mdio-util/mdio-util_0.1.bb
new file mode 100644
index 0000000..9a619b4
--- /dev/null
+++ b/meta-facebook/meta-bletchley/recipes-bletchley/mdio-util/mdio-util_0.1.bb
@@ -0,0 +1,16 @@
+SUMMARY = "MDIO utility for AST2600"
+PR = "r1"
+LICENSE = "Apache-2.0"
+LIC_FILES_CHKSUM = "file://${COREBASE}/meta/files/common-licenses/Apache-2.0;md5=89aea4e17d99a7cacdbeed46a0096b10"
+
+RDEPENDS:${PN} += "bash"
+
+SRC_URI += " \
+ file://mdio-util \
+"
+S = "${WORKDIR}"
+
+do_install() {
+ install -d ${D}${sbindir}
+ install -m 0755 ${S}/mdio-util ${D}${sbindir}/
+}
\ No newline at end of file