133 lines
4.1 KiB
C
133 lines
4.1 KiB
C
#include <common.h>
|
|
#include <command.h>
|
|
#include <malloc.h>
|
|
#include "asm/arch/mach/ms_types.h"
|
|
#include "asm/arch/mach/platform.h"
|
|
#include "asm/arch/mach/io.h"
|
|
|
|
#if defined(CONFIG_INFINITY5)
|
|
#include "../drivers/mstar/isp/snr_cfg_infinity5.h"
|
|
|
|
int do_sensor_cfg(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
|
|
{
|
|
if (argc < 7)
|
|
{
|
|
printf("missing parameters\n");
|
|
return CMD_RET_USAGE;
|
|
}
|
|
|
|
u32 SnrIdx = simple_strtol(argv[1], 0, 10);
|
|
u32 BusType = simple_strtol(argv[2], 0, 10);
|
|
u32 PadSel = simple_strtol(argv[3], 0, 10);
|
|
u32 MclkIdx = simple_strtol(argv[4], 0, 10);
|
|
u32 Pdwn = simple_strtol(argv[5], 0, 10);
|
|
u32 Rst = simple_strtol(argv[6], 0, 10);
|
|
|
|
Set_SNR_BusType(SnrIdx, BusType);
|
|
Set_SNR_IOPad(SnrIdx, PadSel);
|
|
Set_SNR_MCLK(SnrIdx, MclkIdx>=999?0:1, MclkIdx);
|
|
|
|
SNR_PowerDown(SnrIdx, Pdwn);
|
|
SNR_Reset(SnrIdx, Rst);
|
|
|
|
printf("\n Sensor configuration, ID=%u, Bus=%u, Pad=%u, MCLK=%u, PWD_PIN=%u, RST_PIN=%u \n\n",
|
|
SnrIdx, BusType, PadSel, MclkIdx, Pdwn, Rst);
|
|
return 0;
|
|
}
|
|
|
|
U_BOOT_CMD(
|
|
srcfg, CONFIG_SYS_MAXARGS, 1, do_sensor_cfg,
|
|
"sensor pin and mclk configuration.",
|
|
"SensorId BusType PadSel MclkIdx PwdPin RstPin\n"
|
|
" -SensorId Select sensor ID 0~1\n"
|
|
" -BusType Select sensor bus type 0:Parallel, 1:MIPI_1Lane, 2:MIPI_2Lane, 3:MIPI_4Lane, 4:BT656\n"
|
|
" -PadSel Select sensor pad 1~5\n"
|
|
" -MclkIdx 0:27MHz, 1:72MHz, 2:61.7MHz, 3:54MHz, 4:48MHz, 5:43.2MHz, \
|
|
6:36MHz, 7:24MHz, 8:21.6MHz, 9:12MHz, 10:5.4MHz, 999:MCLK off\n"
|
|
" -PwdPin sensor power down pin 0:low 1:high\n"
|
|
" -RstPin sensor reset pin 0:low 1:high\n"
|
|
);
|
|
#elif defined(CONFIG_INFINITY6)
|
|
#include "../drivers/mstar/isp/snr_cfg_infinity6.h"
|
|
|
|
int do_sensor_cfg(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
|
|
{
|
|
if (argc < 6)
|
|
{
|
|
printf("missing parameters\n");
|
|
return CMD_RET_USAGE;
|
|
}
|
|
|
|
u32 PdnPad = simple_strtol(argv[1], 0, 10);
|
|
u32 RstPad = simple_strtol(argv[2], 0, 10);
|
|
u32 MclkIdx = simple_strtol(argv[3], 0, 10);
|
|
u32 Pdwn = simple_strtol(argv[4], 0, 10);
|
|
u32 Rst = simple_strtol(argv[5], 0, 10);
|
|
|
|
Set_SNR_IOPad(0);
|
|
Set_SNR_PdnPad(PdnPad);
|
|
Set_SNR_RstPad(RstPad);
|
|
Set_SNR_MCLK(0, MclkIdx>=999?0:1, MclkIdx);
|
|
|
|
SNR_PowerDown(0, Pdwn);
|
|
SNR_Reset(0, Rst);
|
|
|
|
printf("\n Sensor configuration, PdnPad=%u, RstPad=%u, MCLK=%u, PWD_PIN=%u, RST_PIN=%u \n\n",
|
|
PdnPad, RstPad, MclkIdx, Pdwn, Rst);
|
|
return 0;
|
|
}
|
|
|
|
U_BOOT_CMD(
|
|
srcfg, CONFIG_SYS_MAXARGS, 1, do_sensor_cfg,
|
|
"sensor pin and mclk configuration.",
|
|
"PdnPad RstPad MclkIdx PwdPin RstPin\n"
|
|
" -PdnPad Select sensor power down pad 1:PAD_SR_IO12, 2:PAD_PWM0\n"
|
|
" -RstPad Select sensor reset pad 1:PAD_SR_IO13, 2:PAD_PWM1\n"
|
|
" -MclkIdx 0:27MHz, 1:72MHz, 2:61.7MHz, 3:54MHz, 4:48MHz, 5:43.2MHz, \
|
|
6:36MHz, 7:24MHz, 8:21.6MHz, 9:12MHz, 10:5.4MHz, 999:MCLK off\n"
|
|
" -PwdPin sensor power down pin 0:low 1:high\n"
|
|
" -RstPin sensor reset pin 0:low 1:high\n"
|
|
);
|
|
#else
|
|
#include <../drivers/mstar/isp/isp_pub.h>
|
|
|
|
int do_sensor_cfg(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
|
|
{
|
|
if (argc < 5)
|
|
{
|
|
printf("missing parameters\n");
|
|
return CMD_RET_USAGE;
|
|
}
|
|
|
|
u32 pad = simple_strtol(argv[1],0,10);
|
|
u32 mclk = simple_strtol(argv[2],0,10);
|
|
u32 pdwn = simple_strtol(argv[3],0,10);
|
|
u32 rst = simple_strtol(argv[4],0,10);
|
|
|
|
Select_SR_IOPad((SR_PAD_CFG)pad);
|
|
Set_SR_MCLK(mclk>=999?0:1, mclk);
|
|
|
|
ISP_SrPwdn(0, pdwn);
|
|
ISP_SrRst(0, rst);
|
|
ISP_SrPwdn(1, pdwn);
|
|
ISP_SrRst(1, rst);
|
|
printf("\n sensor configuration, PAD=%u,MCLK=%uMHz, PWD_PIN=%u, RST_PIN=%u \n\n",pad,mclk,pdwn,rst);
|
|
return 0;
|
|
}
|
|
|
|
U_BOOT_CMD(
|
|
srcfg, CONFIG_SYS_MAXARGS, 1, do_sensor_cfg,
|
|
"sensor pin and mclk configuration.",
|
|
"pad mclk pwd_pin rst_pin\n"
|
|
" -pad Select sensor pad 0~6\n"
|
|
" -mclk 0:5.4MHz 1:12MHz 2:21.6MHz 3:27MHz 4:36MHz 5:43.2MHz 6:54MHz 7:61.7MHz 999:MCLK off\n"
|
|
" -pwd_pin sensor power down pin 0:low 1:high\n"
|
|
" -rst_pin sensor reset pin 0:low 1:high\n"
|
|
);
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|