#!/bin/sh

usage () {
    echo "Usage is as follows:"
    echo
    echo "$PROGRAM <--usage|--help|-?>"
    echo "    Prints this usage output and exits."
    echo "$PROGRAM [--ifc eth<n>] --phy <addr> --mmd <addr> --reg <addr> [--val <value>]"
    echo "    read / write to given phy using mmd device and register address."
    echo
}

# RETURN VALUES/EXIT STATUS CODES
readonly E_BAD_OPTION=254
readonly E_UNKNOWN=255

IFC=eth0

# Process command-line arguments.
while test $# -gt 0; do
    case $1 in
        --ifc )
            shift
            IFC="$1"
            shift
            ;;
        --phy )
            shift
            PHY="$1"
            shift
            ;;
        --mmd )
            shift
            MMD="$1"
            shift
            ;;
        --reg )
            shift
            REG="$1"
            shift
            ;;
        --val )
            shift
            VAL="$1"
            shift
            ;;
        --verbose )
            DBG=yes
            shift
            ;;

        -? | --usage | --help )
            usage
            exit
            ;;

        -* )
            echo "Unrecognized option: $1" >&2
            usage
            exit $E_BAD_OPTION
            ;;

        * )
            break
            ;;
    esac
done

if [ "x$PHY" == "x" ]; then
	echo "missing phy_id"
	exit $E_BAD_OPTION
fi

if [ "x$MMD" == "x" ]; then
	echo "missing mmd dev"
	exit $E_BAD_OPTION
fi

if [ "x$REG" == "x" ]; then
	echo "missing mmd reg"
	exit $E_BAD_OPTION
fi

if [ "x$DBG" != "x" ]; then
	echo "ifc:  $IFC";
	echo "phy:  $PHY";
	echo "mmd:  $MMD";
	echo "reg:  $REG";
fi

access_spec=$(printf "0x%x\n" $((0x4000+$MMD)) )

### echo "access_spec $access_spec"

if [ "x$VAL" == "x" ]; then
	phyio -d $IFC -a $PHY -r 0xd -w $MMD
	phyio -d $IFC -a $PHY -r 0xe -w $REG
	phyio -d $IFC -a $PHY -r 0xd -w $access_spec
	phyio -d $IFC -a $PHY -r 0xe
else
	echo "mmd reg val: $4"
	phyio -d $IFC -a $PHY -r 0xd -w $MMD
	phyio -d $IFC -a $PHY -r 0xe -w $REG
	phyio -d $IFC -a $PHY -r 0xd -w $access_spec
	phyio -d $IFC -a $PHY -r 0xe -w $VAL
fi
