#!/bin/sh
#
# OpenIPC.org | 2023.07.01
#

PATH_MODULE=/lib/modules/4.9.84/sigmastar
SENSOR=$(fw_printenv -n sensor)

detect_sensor() {
  insmod ${PATH_MODULE}/sensor_rx_mipi.ko chmap=1
  SENSOR=$(majestic | awk '/Autodetect/ {print $NF}')
  rmmod drv_ms_cus_RX_MIPI
  fw_setenv sensor ${SENSOR}
}

set_sensor() {
  $(lsmod | grep -q ${SENSOR}) && rmmod drv_ms_cus_${SENSOR}_MIPI

  case $SENSOR in
    gc4653|imx335|sc2239|sc3335)
      insmod ${PATH_MODULE}/sensor_${SENSOR}_mipi.ko chmap=1
      ;;
    gc2053|sc2335)
      insmod ${PATH_MODULE}/sensor_${SENSOR}_mipi.ko chmap=1 lane_num=2 hdr_lane_num=2
      ;;
    imx307)
      insmod ${PATH_MODULE}/sensor_${SENSOR}_mipi.ko chmap=1 lane_num=2 hdr_lane_num=2 mclk=37.125M
      ;;
    *)
      echo -e "\n\e[1;31mUNSUPPORTED sensor found - ${SENSOR}\e[0m\n" | logger -s -t OpenIPC
      ;;
  esac
}

insert_ko() {
  insmod ${PATH_MODULE}/mhal.ko
  insmod ${PATH_MODULE}/mi_common.ko
  insmod ${PATH_MODULE}/mi_sys.ko cmdQBufSize=256 logBufSize=256
  insmod ${PATH_MODULE}/mi_rgn.ko
  insmod ${PATH_MODULE}/mi_ai.ko
  insmod ${PATH_MODULE}/mi_ao.ko
  insmod ${PATH_MODULE}/mi_sensor.ko
  insmod ${PATH_MODULE}/mi_shadow.ko
  insmod ${PATH_MODULE}/mi_divp.ko
  insmod ${PATH_MODULE}/mi_vif.ko
  insmod ${PATH_MODULE}/mi_vpe.ko
  insmod ${PATH_MODULE}/mi_venc.ko fw_path=/etc/firmware/chagall.bin

  major=$(awk '$2=="mi_poll" {print $1}' /proc/devices)
  mknod /dev/mi_poll c $major 0

  echo isproot /etc/firmware/iqfile > /dev/ispmid
  mdev -s
}

if [ ! -e /dev/mi_poll ]; then
  insert_ko
fi

if [ -z ${SENSOR} ]; then
  echo -e "\n\e[1;33mAutodetect sensor\e[0m\n" | logger -s -t OpenIPC
  detect_sensor
fi

if [ -z ${SENSOR} ]; then
  echo -e "\n\e[1;31mSensor parameter is MISSING\e[0m\n" | logger -s -t OpenIPC
  exit 1
else
  echo -e "\n\e[1;32mSensor is assigned - ${SENSOR}\e[0m\n" | logger -s -t OpenIPC
  set_sensor
fi

exit 0