#!/bin/sh
# ==============================================================================
# i.MX28 Power & Clock Configuration Script (for SHARP Brain / Brainux)
# ==============================================================================
# 【使い方】
#   sudo ./clkset.sh <プロファイル> [オプション]
#   sudo ./clkset.sh -c <CPUFRAC値> [オプション]
#
# 【オプション】
#   -c <12-63>       : CPUFRAC値を直接指定 (プロファイル名の代わりに使用)
#   -v <0-31>        : コア電圧 (TRG値) を個別指定 (例: -v 30 -> 1.550 V)
#   -b <0x01-0x3F>   : HBUS設定値を個別指定       (例: -b 0x2B -> 11/32分周)
#   -d               : ドライラン (実際の書き換えを行わず計算結果のみ表示)
#   -n               : 変更後の clkinfo.sh 自動表示をスキップ
#   -h               : ヘルプ（プロファイル・オプション一覧）を表示
# ==============================================================================

# ==============================================================================
# ユーザー設定変数 (ここを変更するだけで全体のAHBバスクロック上限判定が連動します)
# ==============================================================================
MAX_HBUS_MHZ=240   # AHBバス上限周波数 (MHz単位の整数: 例 240 -> 240.00 MHz)
# ==============================================================================


if [ "$(id -u)" -ne 0 ]; then
    exec sudo "$0" "$@"
fi


MAX_HBUS_KHZ=$(( MAX_HBUS_MHZ * 1000 ))

show_help() {
    cat << EOF
Usage:
  $0 <profile> [options]
  $0 -c <CPUFRAC> [options]

[Profiles (Current AHB Bus Limit: ${MAX_HBUS_MHZ}.00 MHz)]
  261  : 261.82 MHz (CPUFRAC=33) | VDDD: 1.350 V (TRG=22) | HBUS: 0x02 (1/2)   -> 130.91 MHz
  360  : 360.00 MHz (CPUFRAC=24) | VDDD: 1.400 V (TRG=24) | HBUS: 0x2C (12/32) -> 135.00 MHz
  454  : 454.74 MHz (CPUFRAC=19) | VDDD: 1.550 V (TRG=30) | HBUS: 0x2E (14/32) -> 198.95 MHz
  480  : 480.00 MHz (CPUFRAC=18) | VDDD: 1.550 V (TRG=30) | HBUS: 0x2E (14/32) -> 210.00 MHz
  508  : 508.24 MHz (CPUFRAC=17) | VDDD: 1.575 V (TRG=31) | HBUS: 0x2E (14/32) -> 222.35 MHz
  540  : 540.00 MHz (CPUFRAC=16) | VDDD: 1.575 V (TRG=31) | HBUS: 0x2E (14/32) -> 236.25 MHz
  576  : 576.00 MHz (CPUFRAC=15) | VDDD: 1.575 V (TRG=31) | HBUS: 0x2D (13/32) -> 234.00 MHz
  617  : 617.14 MHz (CPUFRAC=14) | VDDD: 1.575 V (TRG=31) | HBUS: 0x2C (12/32) -> 231.43 MHz
  664  : 664.62 MHz (CPUFRAC=13) | VDDD: 1.575 V (TRG=31) | HBUS: 0x2B (11/32) -> 228.46 MHz
  720  : 720.00 MHz (CPUFRAC=12) | VDDD: 1.575 V (TRG=31) | HBUS: 0x2A (10/32) -> 225.00 MHz

[Options]
  -c <12-63>     Specify CPUFRAC directly (480MHz * 18 / CPUFRAC)
  -v <0-31>      Override core voltage (TRG value)
  -b <0x01-0x3F> Override HBUS divider setting
  -d             Dry run (show calculated settings without writing registers)
  -n             Skip running clkinfo.sh after applying settings
  -h             Show this help message
EOF

  if [ "$NO_INFO" -eq 0 ]; then
      SCRIPT_DIR=$(dirname "$0")
      if [ -x "$SCRIPT_DIR/clkinfo.sh" ]; then
          echo ""
          "$SCRIPT_DIR/clkinfo.sh"
      fi
  fi
}

OPT_CPUFRAC=""
OPT_TRG=""
OPT_HBUS=""
DRY_RUN=0
NO_INFO=0
PROFILE=""

# 引数パース処理
while [ $# -gt 0 ]; do
    case "$1" in
        -h|--help)
            show_help
            exit 0
            ;;
        -c)
            if [ -z "$2" ]; then
                echo "Error: -c option requires a CPUFRAC value (12-63)."
                exit 1
            fi
            OPT_CPUFRAC="$2"
            shift 2
            ;;
        -v)
            if [ -z "$2" ]; then
                echo "Error: -v option requires a TRG value (0-31)."
                exit 1
            fi
            OPT_TRG="$2"
            shift 2
            ;;
        -b)
            if [ -z "$2" ]; then
                echo "Error: -b option requires an HBUS setting (0x01-0x3F)."
                exit 1
            fi
            OPT_HBUS="$2"
            shift 2
            ;;
        -d|--dry-run)
            DRY_RUN=1
            shift
            ;;
        -n)
            NO_INFO=1
            shift
            ;;
        -*)
            echo "Error: Unknown option '$1' (use -h for help)."
            exit 1
            ;;
        *)
            if [ -z "$PROFILE" ]; then
                PROFILE="$1"
            else
                echo "Error: Extra argument '$1' specified (use -h for help)."
                exit 1
            fi
            shift
            ;;
    esac
done


if [ -z "$PROFILE" ] && [ -z "$OPT_CPUFRAC" ]; then
    show_help
    exit 1
fi


# レジスタ物理アドレス定義
ADDR_VDDD="0x80044040"   # HW_POWER_VDDDCTRL
ADDR_FRAC0="0x800401B0"  # HW_CLKCTRL_FRAC0
ADDR_CPU="0x80040050"    # HW_CLKCTRL_CPU
ADDR_HBUS="0x80040060"   # HW_CLKCTRL_HBUS
ADDR_CLKSEQ="0x800401D0" # HW_CLKCTRL_CLKSEQ

# 1. ベース設定の決定 (プロファイル指定 または -c 直接指定)
if [ -n "$PROFILE" ]; then
    case "$PROFILE" in
        261) LABEL="261.82 MHz (Power Save)";       TARGET_TRG=22; TARGET_CPUFRAC=33; TARGET_HBUS_VAL=0x02 ;;
        360) LABEL="360.00 MHz (Medium)";           TARGET_TRG=24; TARGET_CPUFRAC=24; TARGET_HBUS_VAL=0x2C ;;
        454) LABEL="454.74 MHz (Brainux Default)";  TARGET_TRG=30; TARGET_CPUFRAC=19; TARGET_HBUS_VAL=0x2E ;;
        480) LABEL="480.00 MHz (Stock Max FRAC)";   TARGET_TRG=30; TARGET_CPUFRAC=18; TARGET_HBUS_VAL=0x2E ;;
        508) LABEL="508.24 MHz (Practical OC)";     TARGET_TRG=31; TARGET_CPUFRAC=17; TARGET_HBUS_VAL=0x2E ;;
        540) LABEL="540.00 MHz (Extreme Test 1)";   TARGET_TRG=31; TARGET_CPUFRAC=16; TARGET_HBUS_VAL=0x2E ;;
        576) LABEL="576.00 MHz (Extreme Test 2)";   TARGET_TRG=31; TARGET_CPUFRAC=15; TARGET_HBUS_VAL=0x2D ;;
        617) LABEL="617.14 MHz (Extreme Test 3)";   TARGET_TRG=31; TARGET_CPUFRAC=14; TARGET_HBUS_VAL=0x2C ;;
        664) LABEL="664.62 MHz (Extreme Test 4)";   TARGET_TRG=31; TARGET_CPUFRAC=13; TARGET_HBUS_VAL=0x2B ;;
        720) LABEL="720.00 MHz (Extreme Test 5)";   TARGET_TRG=31; TARGET_CPUFRAC=12; TARGET_HBUS_VAL=0x2A ;;
        *)
            echo "Error: Invalid profile '$PROFILE'."
	    show_help
            exit 1
            ;;
    esac
fi

# 2. -c オプションによる CPUFRAC 直接指定・上書き
if [ -n "$OPT_CPUFRAC" ]; then
    case "$OPT_CPUFRAC" in
        *[!0-9]*|"")
            echo "Error: -c option must be an integer between 12 and 63."
            exit 1
            ;;
    esac
    if [ "$OPT_CPUFRAC" -ge 12 ] && [ "$OPT_CPUFRAC" -le 63 ]; then
        TARGET_CPUFRAC="$OPT_CPUFRAC"
        if [ -z "$PROFILE" ]; then
            if [ "$TARGET_CPUFRAC" -le 17 ]; then
                TARGET_TRG=31
            elif [ "$TARGET_CPUFRAC" -le 19 ]; then
                TARGET_TRG=30
            elif [ "$TARGET_CPUFRAC" -le 24 ]; then
                TARGET_TRG=24
            else
                TARGET_TRG=22
            fi
            TARGET_HBUS_VAL=0x2E
        fi
        TMP_KHZ=$(( 480000 * 18 / TARGET_CPUFRAC ))
        TMP_MH=$(( TMP_KHZ / 1000 ))
        TMP_KH=$(( (TMP_KHZ % 1000 + 5) / 10 ))
        [ "$TMP_KH" -ge 100 ] && TMP_MH=$(( TMP_MH + 1 )) && TMP_KH=0
        LABEL=$(printf "%d.%02d MHz (Direct CPUFRAC=%d)" "$TMP_MH" "$TMP_KH" "$TARGET_CPUFRAC")
    else
        echo "Error: -c option must be in the range 12-63."
        exit 1
    fi
fi

# 3. -v オプションによる電圧上書き検証
if [ -n "$OPT_TRG" ]; then
    case "$OPT_TRG" in
        *[!0-9]*|"")
            echo "Error: -v option must be an integer between 0 and 31."
            exit 1
            ;;
    esac
    if [ "$OPT_TRG" -ge 0 ] && [ "$OPT_TRG" -le 31 ]; then
        TARGET_TRG="$OPT_TRG"
    else
        echo "Error: -v option must be in the range 0-31."
        exit 1
    fi
fi

# 4. -b オプションによる HBUS上書き検証
HBUS_EXPLICIT=0
if [ -n "$OPT_HBUS" ]; then
    case "$OPT_HBUS" in
        0x*[!0-9a-fA-F]*|0X*[!0-9a-fA-F]*|0x|0X|"")
            echo "Error: -b option must be a hex or integer value between 0x01 and 0x3F."
            exit 1
            ;;
        0x*|0X*) ;;
        *[!0-9]*)
            echo "Error: -b option must be a hex or integer value between 0x01 and 0x3F."
            exit 1
            ;;
    esac
    if HBUS_PARSED=$(( OPT_HBUS )) 2>/dev/null && [ "$HBUS_PARSED" -ge 1 ] && [ "$HBUS_PARSED" -le 63 ] && [ $(( HBUS_PARSED & 0x1F )) -ge 1 ]; then
        TARGET_HBUS_VAL=$(printf "0x%02X" "$HBUS_PARSED")
        HBUS_EXPLICIT=1
    else
        echo "Error: -b option must be between 0x01 and 0x3F (with lower 5-bit DIV >= 1)."
        exit 1
    fi
fi

# 5. AHBバス上限 (MAX_HBUS_MHZ) チェック＆自動リミッター
TARGET_CPU_KHZ=$(( 480000 * 18 / TARGET_CPUFRAC ))
HBUS_FRAC_EN=$(( (TARGET_HBUS_VAL >> 5) & 0x01 ))
HBUS_DIV=$(( TARGET_HBUS_VAL & 0x1F ))

if [ "$HBUS_FRAC_EN" -eq 1 ]; then
    CALC_HBUS_KHZ=$(( TARGET_CPU_KHZ * HBUS_DIV / 32 ))
else
    CALC_HBUS_KHZ=$(( TARGET_CPU_KHZ / HBUS_DIV ))
fi

if [ "$CALC_HBUS_KHZ" -gt "$MAX_HBUS_KHZ" ]; then
    if [ "$HBUS_EXPLICIT" -eq 1 ]; then
        echo "Warning: Specified HBUS ($TARGET_HBUS_VAL) causes AHB bus clock to exceed limit (${MAX_HBUS_MHZ}.00 MHz)."
    else
        SAFE_DIV=$(( MAX_HBUS_KHZ * 32 / TARGET_CPU_KHZ ))
        [ "$SAFE_DIV" -lt 1 ] && SAFE_DIV=1
        TARGET_HBUS_VAL=$(printf "0x%02X" $(( 0x20 | SAFE_DIV )))
        HBUS_FRAC_EN=1
        HBUS_DIV=$SAFE_DIV
        CALC_HBUS_KHZ=$(( TARGET_CPU_KHZ * HBUS_DIV / 32 ))
        echo "Notice: Adjusted HBUS divider to ${SAFE_DIV}/32 ($TARGET_HBUS_VAL) to stay within AHB bus limit (${MAX_HBUS_MHZ} MHz)."
    fi
fi

# 表示用の文字列生成
VDDD_MV=$(( 800 + TARGET_TRG * 25 ))
VDDD_STR=$(printf "%d.%03d V" $(( VDDD_MV / 1000 )) $(( VDDD_MV % 1000 )))
TRG_HEX=$(printf "0x%02X" "$TARGET_TRG")
FRAC_HEX=$(printf "0x%02X" "$TARGET_CPUFRAC")

HBUS_HEX=$(printf "0x%02X" "$TARGET_HBUS_VAL")
if [ "$HBUS_FRAC_EN" -eq 1 ]; then
    HBUS_RATIO_STR="Frac Div ${HBUS_DIV}/32"
else
    HBUS_RATIO_STR="Int Div 1/${HBUS_DIV}"
fi

HBUS_MH=$(( CALC_HBUS_KHZ / 1000 ))
HBUS_KH=$(( (CALC_HBUS_KHZ % 1000 + 5) / 10 ))
if [ "$HBUS_KH" -ge 100 ]; then
    HBUS_MH=$(( HBUS_MH + 1 ))
    HBUS_KH=0
fi
HBUS_MHZ_STR=$(printf "%d.%02d MHz" "$HBUS_MH" "$HBUS_KH")

# ビジーフラグのクリア待機関数
wait_cpu_busy() {
    i=0
    while [ "$i" -lt 1000 ]; do
        v=$(busybox devmem "$ADDR_CPU")
        if [ $(( (v >> 28) & 0x01 )) -eq 0 ]; then
            return 0
        fi
        i=$(( i + 1 ))
    done
    echo "Warning: Timeout waiting for BUSY_REF_CPU to clear."
}

wait_hbus_busy() {
    i=0
    while [ "$i" -lt 1000 ]; do
        v=$(busybox devmem "$ADDR_HBUS")
        if [ $(( (v >> 31) & 0x01 )) -eq 0 ]; then
            return 0
        fi
        i=$(( i + 1 ))
    done
    echo "Warning: Timeout waiting for HBUS BUSY to clear."
}

set_vddd() {
    cur=$(busybox devmem "$ADDR_VDDD")
    nxt=$(printf "0x%08X" $(( (cur & ~0x1F) | ($1 & 0x1F) )))
    busybox devmem "$ADDR_VDDD" 32 "$nxt"
    busybox devmem "$ADDR_VDDD" > /dev/null
    busybox usleep 2000 2>/dev/null || sleep 1
}

set_hbus() {
    cur=$(busybox devmem "$ADDR_HBUS")
    nxt=$(printf "0x%08X" $(( (cur & ~0x3F) | ($1 & 0x3F) )))
    busybox devmem "$ADDR_HBUS" 32 "$nxt"
    wait_hbus_busy
}

set_cpufrac() {
    cur=$(busybox devmem "$ADDR_FRAC0")
    nxt=$(printf "0x%08X" $(( (cur & ~0xBF) | ($1 & 0x3F) )))
    busybox devmem "$ADDR_FRAC0" 32 "$nxt"
    wait_cpu_busy

    cur_c=$(busybox devmem "$ADDR_CPU")
    if [ $(( cur_c & 0x3F )) -ne 1 ]; then
        nxt_c=$(printf "0x%08X" $(( (cur_c & ~0x3F) | 0x01 )))
        busybox devmem "$ADDR_CPU" 32 "$nxt_c"
        wait_cpu_busy
    fi
}

echo "Applying configuration: $LABEL"
echo "  CPUFRAC  : $TARGET_CPUFRAC ($FRAC_HEX)"
echo "  Voltage  : TRG=$TARGET_TRG ($TRG_HEX) -> $VDDD_STR"
echo "  HBUS     : $HBUS_HEX ($HBUS_RATIO_STR) -> $HBUS_MHZ_STR"

if [ "$DRY_RUN" -eq 1 ]; then
    echo "Dry run mode (-d): No registers were modified."
    exit 0
fi


CUR_CLKSEQ=$(busybox devmem "$ADDR_CLKSEQ")
if [ $(( (CUR_CLKSEQ >> 18) & 0x01 )) -eq 1 ]; then
    echo "Warning: BYPASS_CPU=1 (24MHz XTAL bypass active); CPUFRAC changes will not affect actual CPU clock."
fi

CUR_FRAC0=$(busybox devmem "$ADDR_FRAC0")
CUR_CPUFRAC=$(( CUR_FRAC0 & 0x3F ))
CUR_VDDD=$(busybox devmem "$ADDR_VDDD")
CUR_TRG=$(( CUR_VDDD & 0x1F ))

if [ "$TARGET_CPUFRAC" -lt "$CUR_CPUFRAC" ] || { [ "$TARGET_CPUFRAC" -eq "$CUR_CPUFRAC" ] && [ "$TARGET_TRG" -ge "$CUR_TRG" ]; }; then
    echo "  [1/3] Setting core voltage (VDDD)..."
    set_vddd "$TARGET_TRG"
    echo "  [2/3] Adjusting AHB bus divider (CLK_HBUS=$HBUS_HEX)..."
    set_hbus "$TARGET_HBUS_VAL"
    echo "  [3/3] Setting CPU clock (CPUFRAC=$TARGET_CPUFRAC)..."
    set_cpufrac "$TARGET_CPUFRAC"
else
    echo "  [1/3] Setting CPU clock (CPUFRAC=$TARGET_CPUFRAC)..."
    set_cpufrac "$TARGET_CPUFRAC"
    echo "  [2/3] Adjusting AHB bus divider (CLK_HBUS=$HBUS_HEX)..."
    set_hbus "$TARGET_HBUS_VAL"
    echo "  [3/3] Setting core voltage (VDDD)..."
    set_vddd "$TARGET_TRG"
fi

echo "Configuration applied successfully."


if [ "$NO_INFO" -eq 0 ]; then
    SCRIPT_DIR=$(dirname "$0")
    if [ -x "$SCRIPT_DIR/clkinfo.sh" ]; then
        echo ""
        "$SCRIPT_DIR/clkinfo.sh"
    fi
fi


