#!/bin/sh
# 
# Copyright (c) 2014-2020 Florian Wesch <fw@dividuum.de>
# All rights reserved. No warranty, explicit or implicit, provided.
#

echo -e "\n    \e[1m\e[97mBooting up..\e[0m\n"

VERSION=$(cat /etc/version)
TAG=$(cat /etc/tag)
CHANNEL=$(cat /etc/channel)
export VERSION TAG CHANNEL ARCH

mount -t proc proc /proc
mount -t sysfs sysfs /sys

# Auto reboot on kernel panic
echo 5 > /proc/sys/kernel/panic
echo 1 > /proc/sys/kernel/hung_task_panic

# Wait for the SD partition to appear.
# This might take a moment on the compute module.
echo -n "[*] Waiting for storage device"
while true; do
    /sbin/mdev -s
    if [ -e /dev/mmcblk0p1 ]; then
        break
    fi
    sleep 0.1
    echo -n "."
done
echo

fatal() {
    echo "[*] Something is wrong with the storage device."
    sdtool /dev/mmcblk0 status
    if [ $? -ne 253 ]; then
        echo "[*] Trying to unlock.."
        sdtool /dev/mmcblk0 unlock
    fi
    echo "[*] Rebooting in 10 seconds."
    sleep 10
    reboot -f
    exit 1
}

SIGNATURE=$(dd if=/dev/mmcblk0p1 bs=1 skip=3 count=6 2> /dev/null)
BOOT_MODE="confirmed"
if [ "$SIGNATURE" == "IBHOST" ]; then
    MODE=$(dd if=/dev/mmcblk0p1 bs=1 skip=9 count=1 2> /dev/null)
    if [ "$MODE" == "T" ]; then
        DISK=$(dd if=/dev/mmcblk0p1 bs=1 skip=10 count=1 2> /dev/null)
        if [ "$DISK" == "A" ]; then
            # Restore boot sector of B
            BOOT_MODE="trial A"
            dd if=/dev/mmcblk0 of=/dev/mmcblk0 bs=512 skip=2 count=1 conv=fsync 2> /dev/null
            dmesg | grep "mmcblk0: error -5 transferring" > /dev/null && fatal
        elif [ "$DISK" == "B" ]; then
            # Restore boot sector of A
            BOOT_MODE="trial B"
            dd if=/dev/mmcblk0 of=/dev/mmcblk0 bs=512 skip=1 count=1 conv=fsync 2> /dev/null
            dmesg | grep "mmcblk0: error -5 transferring" > /dev/null && fatal
        else
            BOOT_MODE="unknown"
        fi

        #  Set a deadline of 6 minutes (see also syncer)
        /sbin/reboot -d 360 -f &
    else
        BOOT_MODE="confirmed"
    fi
else
    BOOT_MODE="first boot"
fi

echo "[*] ${CHANNEL}:${VERSION}:${TAG} (${BOOT_MODE})"

mount /dev/mmcblk0p1 /sd -tvfat -o ro,errors=panic,fmask=117,dmask=007

readahead /sd/stage2.img &

RELEASE=$(uname -r|cut -d"-" -f2)
if [ "$RELEASE" == "v7l+" ]; then
    ARCH=v8
elif [ "$RELEASE" == "v7+" ]; then
    ARCH=v7
else
    ARCH=v6
fi

echo "[*] $(cat /sys/firmware/devicetree/base/model). Using ${ARCH}"

echo 1 > /proc/sys/kernel/printk

MODULES=/modules/$ARCH

insmod $MODULES/squashfs.ko
insmod $MODULES/evdev.ko
insmod $MODULES/crc-ccitt.ko
insmod $MODULES/x_tables.ko
insmod $MODULES/ip_tables.ko
insmod $MODULES/iptable_filter.ko
insmod $MODULES/xt_tcpudp.ko
insmod $MODULES/nf_defrag_ipv4.ko
insmod $MODULES/nf_defrag_ipv6.ko
insmod $MODULES/nf_reject_ipv4.ko
insmod $MODULES/ipt_REJECT.ko
insmod $MODULES/nf_conntrack.ko
insmod $MODULES/xt_state.ko
insmod $MODULES/nf_nat.ko
insmod $MODULES/nf_nat_ipv4.ko
insmod $MODULES/ipt_MASQUERADE.ko
insmod $MODULES/iptable_nat.ko
insmod $MODULES/xt_REDIRECT.ko
insmod $MODULES/xt_owner.ko
insmod $MODULES/rfkill.ko
insmod $MODULES/cfg80211.ko
insmod $MODULES/mac80211.ko
insmod $MODULES/overlay.ko
insmod $MODULES/i2c-bcm2835.ko
insmod $MODULES/tun.ko

# gamepad
insmod $MODULES/ff-memless.ko
insmod $MODULES/xpad.ko

# crypto
insmod $MODULES/cryptd.ko
insmod $MODULES/crypto_simd.ko 2> /dev/null # no available on all platforms
insmod $MODULES/ccm.ko
insmod $MODULES/arc4.ko
insmod $MODULES/ctr.ko
insmod $MODULES/xts.ko
insmod $MODULES/ecb.ko

# edimax driver
insmod $MODULES/8192cu.ko rtw_power_mgnt=0 rtw_enusbss=0

# builtin WiFi on Pi3/Pi0W
insmod $MODULES/brcmutil.ko
insmod $MODULES/brcmfmac.ko

# ralink
insmod $MODULES/rt2x00lib.ko
insmod $MODULES/rt2x00usb.ko
insmod $MODULES/rt2800lib.ko
insmod $MODULES/rt2800usb.ko

# audio
insmod $MODULES/snd.ko
insmod $MODULES/snd-timer.ko
insmod $MODULES/snd-pcm.ko
insmod $MODULES/snd-bcm2835.ko

# goodix touch
insmod $MODULES/goodix.ko

# multitouch
insmod $MODULES/hid-multitouch.ko

# 7" touch
insmod $MODULES/rpi_backlight.ko
insmod $MODULES/rpi-ft5406.ko

# rtc
insmod $MODULES/i2c-dev.ko
insmod $MODULES/i2c-bcm2708.ko
insmod $MODULES/rtc-pcf8523.ko

# dm
insmod $MODULES/dm-mod.ko
insmod $MODULES/dm-crypt.ko

# poe monitoring
insmod $MODULES/hwmon.ko
insmod $MODULES/rpi-poe-fan.ko

# usb serial
insmod $MODULES/usbserial.ko
insmod $MODULES/cp210x.ko
insmod $MODULES/ftdi_sio.ko

# pwm
insmod $MODULES/pwm-bcm2835.ko

if [ "$ARCH" == "v8" ]; then
    # Pi4 DRM/FKMS
    insmod $MODULES/snd-compress.ko
    insmod $MODULES/snd-pcm-dmaengine.ko
    insmod $MODULES/snd-soc-core.ko
    insmod $MODULES/drm_panel_orientation_quirks.ko
    insmod $MODULES/syscopyarea.ko
    insmod $MODULES/sysimgblt.ko
    insmod $MODULES/sysfillrect.ko
    insmod $MODULES/drm.ko
    insmod $MODULES/fb_sys_fops.ko
    insmod $MODULES/drm_kms_helper.ko
    insmod $MODULES/vc4.ko
    insmod $MODULES/gpu-sched.ko
    insmod $MODULES/v3d.ko

    # HEVC decoder
    insmod $MODULES/rpivid-mem.ko
fi

sleep 0.5 # XXX, remove me once the brcmfmac kernel debug messages are gone

echo 4 > /proc/sys/kernel/printk

echo "[*] Drivers loaded"

# apply scaling governor
if [ -e /sd/config/scaling_governor ]; then
    cat /sd/config/scaling_governor > /sys/devices/system/cpu/cpufreq/policy0/scaling_governor 2> /dev/null
fi

# Remove bit60 in Pi4 serial
export SERIAL=$((0x$(grep Serial /proc/cpuinfo|cut -b 11-) & ~0x1000000000000000))

export DEBUG_OUTPUT="/dev/null"
export DEBUG="0"

if [ -e /sd/config/run-post-boot ]; then
    (cd /sd/config && ARCH=$ARCH SERIAL=$SERIAL /bin/sh run-post-boot)
fi

# echo "[*] debug shell. type 'exit' to continue booting"
# /bin/sh

if [ -e /sd/config/ib_sync_host ]; then
    IB_SYNC_HOST=$(cat /sd/config/ib_sync_host)
    echo "[*] Using custom sync host ${IB_SYNC_HOST}"
else
    IB_SYNC_HOST=$(cat /etc/ib_sync_host)
fi

if [ -e /sd/config/control_host ]; then
    CONTROL_HOST=$(cat /sd/config/control_host)
    echo "[*] Using custom control host ${CONTROL_HOST}"
else
    CONTROL_HOST=$(cat /etc/control_host)
fi
export IB_SYNC_HOST CONTROL_HOST

ifconfig lo 127.0.0.1 up

if [ -e /sd/config/debug ]; then
    DEBUG_OUTPUT="/dev/console"
    DEBUG="1"
fi

# Decide network device
export NET_DEV
if [ -e /sd/config/wpa.conf ]; then
    NET_DEV=wlan0
elif [ -e /sd/config/wireless ]; then
    NET_DEV=wlan0
else
    NET_DEV=eth0
fi
if [ "$NET_DEV" == "wlan0" -a -e /sd/config/prefer_wired ]; then
    echo -n "[*] Checking if ethernet is connected "
    for ether_test in `seq 1 15`; do
        if [ -e /sys/class/net/eth0 ]; then
            ifconfig eth0 up 2> /dev/null
            echo -n "+"
            break
        fi
        echo -n "."
        sleep 0.2
    done
    for carrier_test in `seq 1 15`; do
        echo -n "."
        sleep 0.2
        if cat /sys/class/net/eth0/carrier > /dev/null 2> /dev/null; then
            echo -n "+"
            break
        fi
    done
    for link_test in `seq 1 35`; do
        if [ "$(cat /sys/class/net/eth0/carrier 2> /dev/null)" == "1" ]; then
            echo "got link"
            NET_DEV=eth0
            break
        fi
        if [ "$link_test" == "35" ]; then
            echo "no link"
            break
        fi
        echo -n "."
        sleep 0.3
    done
fi
if [ "$NET_DEV" == "wlan0" ]; then
    echo "[*] Using WiFi"
else
    echo "[*] Using Ethernet"
fi

# configure proxy
if [ -e /sd/config/proxy ]; then
    PROXY=$(cat /sd/config/proxy)
    echo "[*] Using proxy ${PROXY}"
    export HTTP_PROXY="http://${PROXY}"
    export HTTPS_PROXY="http://${PROXY}"
    export http_proxy="http://${PROXY}"
    export https_proxy="http://${PROXY}"
fi

# copy stage2 to tmpfs
echo -en "[*] Moving stage2.. "
mkdir /stage2
cp /sd/stage2.img /stage2
mount -t squashfs /stage2/stage2.img /system

mount -t tmpfs none /system/tmp
mount /sd /system/sd -o move
mount /proc /system/proc -o move
mount /sys /system/sys -o move
mount -t debugfs none /system/sys/kernel/debug
echo "ok"

cd /

# echo "[*] debug shell. type 'exit' to continue booting"
# /bin/sh

echo "[*] Entering stage2"

exec switch_root /system /init
