#!/bin/sh
PATH=$PATH:/usr/sbin

# Check if an fb device is available.  If not then just go ahead and
# exit because we have no display.
fbset > /dev/null 2>&1
if [ "$?" == "1" ]
then
	# looks like there is no display, so let's exit
	exit 0
fi

BITSPERPIXEL="$(fbset | grep geom | awk '{print $6}')"
YRES="$(fbset | grep geom | awk '{print $3}')"

CPUTYPE="$(cputype)"

if [ "$1" = "" ]; then
	echo PVR-INIT: Please use start, stop, or restart.
	exit 1
fi

if [ "$1" = "stop" -o  "$1" = "restart" ]; then
	echo Stopping PVR
	rmmod bufferclass_ti
	rmmod omaplfb 2>/dev/null
	rmmod pvrsrvkm 2>/dev/null
fi

if [ "$1" = "stop" ]; then
	exit 0
fi

# Set RGBA ordering to something the drivers like
if [ "$BITSPERPIXEL" = "32" ] ; then
	fbset -rgba 8/16,8/8,8/0,8/24
fi

# Try to enable triple buffering when there's enough VRAM
fbset -vyres $(expr $YRES \* 3)

sgxprepare () {
	echo Starting PVR

	lsmod | grep pvrsrvkm > /dev/null

	if [ "$?" != "0" ]
	then
		insmod $(busybox find /lib/modules/$(uname -r) -name "pvrsrvkm.ko")

		if [ "$?" != "0" ]
		then
			echo "Could not find pvrsrvkm driver"
			exit 1
		fi
	fi

	modprobe omaplfb
	modprobe bufferclass_ti

	pvr_maj=`grep "pvrsrvkm$" /proc/devices | cut -b1,2,3`
	bc_maj=`grep "bc" /proc/devices | cut -b1,2,3`

	if [ -e /dev/pvrsrvkm ] ; then
		rm -f /dev/pvrsrvkm
	fi

	mknod /dev/pvrsrvkm c $pvr_maj 0
	chmod 666 /dev/pvrsrvkm

	touch /etc/powervr-esrev

	SAVED_ESREVISION="$(cat /etc/powervr-esrev)"
}

sgxfinish () {
	# Fix up a bug in opkg
	if [ $(readlink /usr/lib/libsrv_um.so) != $(readlink /usr/lib/libsrv_um.so.1) ] ; then
		cd /usr/lib
		ln -sf $(readlink /usr/lib/libsrv_um.so.1) libsrv_um.so
	fi

	if [ "${ES_REVISION}" != "${SAVED_ESREVISION}" ] ; then
		echo -n "Starting SGX fixup for"
		echo " ES${ES_REVISION}.x"
		cp -a /usr/lib/ES${ES_REVISION}.0/* /usr/lib
		cp -a /usr/bin/ES${ES_REVISION}.0/* /usr/bin
		echo "${ES_REVISION}" > /etc/powervr-esrev
	fi

	if ! /usr/bin/pvrsrvctl --start --no-module; then return; fi
}

case $CPUTYPE in
"OMAP3530")
	sgxprepare

	devmem2 0x48004B48 w 0x2 > /dev/null
	devmem2 0x48004B10 w 0x1 > /dev/null
	devmem2 0x48004B00 w 0x2 > /dev/null

	ES_REVISION="$(devmem2 0x50000014 | sed -e s:0x00010205:5: -e s:0x00010201:3: -e s:0x00010003:2: | tail -n1 | awk -F': ' '{print $2}')"

	sgxfinish
	;;
"TI33XX")
	sgxprepare

	ES_REVISION="$(devmem2 0x56000014 | sed -e s:0x00010205:8: | tail -n1 | awk -F': ' '{print $2}')"

	sgxfinish
	;;
"TI43XX")
	sgxprepare

	ES_REVISION="$(devmem2 0x56000014 | sed -e s:0x00010205:8: | tail -n1 | awk -F': ' '{print $2}')"

	sgxfinish
	;;
"TI816x")
	sgxprepare

	devmem2 0x48180F04 w 0x0 > /dev/null
	devmem2 0x48180900 w 0x2 > /dev/null
	devmem2 0x48180920 w 0x2 > /dev/null

	ES_REVISION="$(devmem2 0x56000014 | sed -e s:0x00010205:6: -e s:0x00010201:3: -e s:0x00010003:2: | tail -n1 | awk -F': ' '{print $2}')"

	sgxfinish
	;;
*)
	echo No SGX hardware, not starting PVR
	;;
esac