/*
 * (c) 2020, SWD Embedded Systems Limited, http://www.kpda.ru
 */


/*************************************************/
/*                    HEADERS                    */
/*************************************************/


#include "vpoutfb.h"


/*************************************************/
/*                  VARS / DEFS                  */
/*************************************************/


static char *vpout_opts[] = {
#define VPOUT_OPT_DISPMODE              0
    "dispmode",
#define VPOUT_OPT_BASE                  1
    "base",
#define VPOUT_OPT_SIZE                  2
    "size",
#define VPOUT_OPT_IRQ                   3
    "irq",
#define VPOUT_OPT_HDMI                  4
    "hdmi",
#define VPOUT_OPT_ENABLE                5
    "enable",
#define VPOUT_OPT_VERBOSE               6
    "verbose",
    NULL
};

int verbose = VPOUT_SLOG_LEVEL_0;


/*************************************************/
/*                   FUNCTIONS                   */
/*************************************************/


int parse_options( disp_adapter_t *adapter, vpout_context_t *vpout, char *filename )
{
    FILE                    *fin     = NULL;
    char                    buf[256],
                            *c       = NULL,
                            *opt     = NULL,
                            *value   = NULL;
    char                    path[255];

    if ( (filename == NULL) || ( strlen( filename ) == 0 ) )
    {
        int                 fd       = 0;

        strcpy( path, "/etc/system/config/vpoutfb.conf" );
        fd = open( path, O_RDONLY );
        if ( fd != -1 )
        {
            close( fd );

            filename = path;
        }
    }

    if ( (filename == NULL) || ( strlen( filename ) == 0 ) ) {
        /* Fatal: configuration file not found */
    } else if ( (fin = fopen( filename, "r" )) == NULL )
        disp_printf( adapter, "[vpoutfb] Critical: could not open config file \"%s\": %s", filename, strerror( errno ) );
    else
        disp_printf( adapter, "[vpoutfb] Configuration: \"%s\"", filename );

    vpout->display[0]     = CONFIG_DISPLAY_PORT_HDMI0;
    vpout->enabled        = 0;
    vpout->registers_size = 0x1000;

    if ( fin == NULL )
    {
        disp_printf( adapter, "[vpoutfb] Fatal: configuration file not found" );

        return (-1);
    }

    while ( fgets( buf, sizeof (buf), fin ) != NULL )
    {
        c = buf;
        while ( *c == ' ' || *c == '\t' )
            c++;
        if ( *c == '\015' || *c== '\032' || *c == '\0' || *c == '\n' || *c == '#' )
            continue;
        opt = c;
        while ( *c == '\015' || *c== '\032' || (*c != '\0' && *c != '\n' && *c != '#') )
            c++;
        *c = '\0';
        break;
    }

    while ( *opt != '\0' )
    {
        c = opt;
        switch ( getsubopt( &opt, vpout_opts, &value ) )
        {
            case VPOUT_OPT_DISPMODE:
                if ( strcmp( value, "hdmi-0" ) == 0 ) {
                    vpout->display[0]     = CONFIG_DISPLAY_PORT_HDMI0;
                    disp_printf( adapter, "[vpoutfb] Configuration: display[0] -> HDMI-0" );
                } else
                    disp_printf( adapter, "[vpoutfb] Warning: unknown display configuration (see vpoutfb.conf)" );
                break;

            case VPOUT_OPT_BASE:
                vpout->registers_base = strtoul( value, NULL, 0 );
                disp_printf( adapter, "[vpoutfb] Configuration: display controller registers base - 0x%08x", vpout->registers_base );
                break;

            case VPOUT_OPT_SIZE:
                vpout->registers_size = strtoul( value, NULL, 0 );
                disp_printf( adapter, "[vpoutfb] Configuration: display controller registers size - 0x%x", vpout->registers_size );
                break;

            case VPOUT_OPT_IRQ:
                vpout->irq = strtoul( value, NULL, 0 );
                disp_printf( adapter, "[vpoutfb] Configuration: display controller interrupt - %d", vpout->irq );
                break;

            case VPOUT_OPT_HDMI:
                if ( strncmp( value, VPOUT_OPT_HDMI_IT66121":", strlen( VPOUT_OPT_HDMI_IT66121 ) + 1 ) == 0 )
                {
                    char    *name = value;
                    int     bus;
                    int     address;
                    int     speed;
                    int     base;
                    int     reg;
                    int     pin;

                    value += strlen( VPOUT_OPT_HDMI_IT66121 );
                    *value= 0;
                    value++;

                    if ( sscanf( value, "%d:0x%x:%d:0x%x:0x%x:%d", &bus, &address, &speed, &base, &reg, &pin ) == 6 )
                    {
                        if ( bus < 0 || bus > 3 )
                        {
                            disp_printf( adapter, "[vpoutfb] Error: HDMI transmitter I2C bus invalid (see vpoutfb.conf)" );
                            break;
                        }

                        if ( address < 0 || address > 0xffff )
                        {
                            disp_printf( adapter, "[vpoutfb] Error: HDMI transmitter I2C address invalid (see vpoutfb.conf)" );
                            break;
                        }

                        if ( speed <= 0 )
                        {
                            disp_printf( adapter, "[vpoutfb] Error: HDMI transmitter I2C speed invalid (see vpoutfb.conf)" );
                            break;
                        }

                        if ( base <= 0 )
                        {
                            disp_printf( adapter, "[vpoutfb] Error: HDMI transmitter GPIO base invalid (see vpoutfb.conf)" );
                            break;
                        }

                        if ( reg < 0xa || reg > 0xd )
                        {
                            disp_printf( adapter, "[vpoutfb] Error: HDMI transmitter GPIO register invalid (see vpoutfb.conf: [0xa; 0xd] expected)" );
                            break;
                        }

                        if ( vpout->hdmi_count >= VPOUT_HDMI_PORTS )
                        {
                            disp_printf( adapter, "[vpoutfb] Error: only %d HDMI ports supported", VPOUT_HDMI_PORTS );
                            break;
                        }

                        vpout->hdmi[vpout->hdmi_count].assigned               = true;
                        strcpy( vpout->hdmi[vpout->hdmi_count].transmitter, name );
                        vpout->hdmi[vpout->hdmi_count].device.it66121.bus     = bus;
                        vpout->hdmi[vpout->hdmi_count].device.it66121.address = address;
                        vpout->hdmi[vpout->hdmi_count].device.it66121.speed   = speed;
                        vpout->hdmi[vpout->hdmi_count].device.it66121.base    = base;
                        vpout->hdmi[vpout->hdmi_count].device.it66121.reg     = reg;
                        vpout->hdmi[vpout->hdmi_count].device.it66121.pin     = pin;
                        vpout->hdmi_count++;

                        disp_printf( adapter, "[vpoutfb] Configuration: HDMI[%d] - controller:%s I2C:bus=%d,address=0x%x,speed=%d GPIO:base=0x%x,reg=GPIO%X,pin=%d",
                                     vpout->hdmi_count - 1, name, bus, address, speed * 1000, base, reg, pin );
                        break;
                    }
                } else
                    if ( strncmp( value, VPOUT_OPT_HDMI_TDA998x":", strlen( VPOUT_OPT_HDMI_TDA998x ) + 1 ) == 0 )
                    {
                        char    *name = value;
                        int     bus;
                        int     address;
                        int     speed;
                        int     video_ports = 0;

                        value += strlen( VPOUT_OPT_HDMI_TDA998x );
                        *value= 0;
                        value++;

                        if ( sscanf( value, "%d:0x%x:%d:0x%x", &bus, &address, &speed, &video_ports ) == 4 )
                        {
                            if ( bus < 0 || bus > 3 )
                            {
                                disp_printf( adapter, "[vpoutfb] Error: HDMI transmitter I2C bus invalid (see vpoutfb.conf)" );
                                break;
                            }

                            if ( address < 0 || address > 0xffff )
                            {
                                disp_printf( adapter, "[vpoutfb] Error: HDMI transmitter I2C address invalid (see vpoutfb.conf)" );
                                break;
                            }

                            if ( speed <= 0 )
                            {
                                disp_printf( adapter, "[vpoutfb] Error: HDMI transmitter I2C speed invalid (see vpoutfb.conf)" );
                                break;
                            }

                            if ( vpout->hdmi_count >= VPOUT_HDMI_PORTS )
                            {
                                disp_printf( adapter, "[vpoutfb] Error: only %d HDMI ports supported", VPOUT_HDMI_PORTS );
                                break;
                            }

                            vpout->hdmi[vpout->hdmi_count].assigned                   = true;
                            strcpy( vpout->hdmi[vpout->hdmi_count].transmitter, name );
                            vpout->hdmi[vpout->hdmi_count].device.tda998x.bus         = bus;
                            vpout->hdmi[vpout->hdmi_count].device.tda998x.address     = address;
                            vpout->hdmi[vpout->hdmi_count].device.tda998x.speed       = speed;
                            vpout->hdmi[vpout->hdmi_count].device.tda998x.video_ports = video_ports;
                            vpout->hdmi_count++;

                            disp_printf( adapter, "[vpoutfb] Configuration: HDMI[%d] - controller:%s I2C:bus=%d,address=0x%x,speed=%d",
                                         vpout->hdmi_count - 1, name, bus, address, speed * 1000 );
                            break;
                        }
                    } else
                        if ( strncmp( value, VPOUT_OPT_HDMI_TFP410EP":", strlen( VPOUT_OPT_HDMI_TFP410EP ) + 1 ) == 0 )
                        {
                            char    *name = value;
                            int     bus;
                            int     address;
                            int     speed;
                            int     ddc_bus;
                            int     ddc_slave;

                            value += strlen( VPOUT_OPT_HDMI_TFP410EP );
                            *value= 0;
                            value++;

                            if ( sscanf( value, "%d:0x%x:%d:%d:0x%x", &bus, &address, &speed, &ddc_bus, &ddc_slave ) == 5 )
                            {
                                if ( bus < 0 || bus > 3 )
                                {
                                    disp_printf( adapter, "[vpoutfb] Error: HDMI transmitter I2C bus invalid (see vpoutfb.conf)" );
                                    break;
                                }

                                if ( address < 0 || address > 0xffff )
                                {
                                    disp_printf( adapter, "[vpoutfb] Error: HDMI transmitter I2C address invalid (see vpoutfb.conf)" );
                                    break;
                                }

                                if ( speed <= 0 )
                                {
                                    disp_printf( adapter, "[vpoutfb] Error: HDMI transmitter I2C speed invalid (see vpoutfb.conf)" );
                                    break;
                                }

                                if ( ddc_bus < 0 || ddc_bus > 2 )
                                {
                                    disp_printf( adapter, "[vpoutfb] Error: HDMI transmitter DDC bus invalid (see vpoutfb.conf)" );
                                    break;
                                }

                                if ( ddc_slave < 0 || ddc_slave > 0x7f )
                                {
                                    disp_printf( adapter, "[vpoutfb] Error: HDMI transmitter DDC slave invalid (see vpoutfb.conf)" );
                                    break;
                                }

                                if ( vpout->hdmi_count >= VPOUT_HDMI_PORTS )
                                {
                                    disp_printf( adapter, "[vpoutfb] Error: only %d HDMI ports supported", VPOUT_HDMI_PORTS );
                                    break;
                                }

                                vpout->hdmi[vpout->hdmi_count].assigned                    = true;
                                strcpy( vpout->hdmi[vpout->hdmi_count].transmitter, name );
                                vpout->hdmi[vpout->hdmi_count].device.tfp410ep.bus         = bus;
                                vpout->hdmi[vpout->hdmi_count].device.tfp410ep.address     = address;
                                vpout->hdmi[vpout->hdmi_count].device.tfp410ep.speed       = speed;
                                vpout->hdmi[vpout->hdmi_count].device.tfp410ep.ddc_bus     = ddc_bus;
                                vpout->hdmi[vpout->hdmi_count].device.tfp410ep.ddc_slave   = ddc_slave;
                                vpout->hdmi_count++;

                                disp_printf( adapter, "[vpoutfb] Configuration: HDMI[%d] - controller:%s I2C:bus=%d,address=0x%x,speed=%d,ddc-bus=%d,ddc-slave=0x%x",
                                             vpout->hdmi_count - 1, name, bus, address, speed * 1000, ddc_bus, ddc_slave );
                                break;
                            }
                        }

                disp_printf( adapter, "[vpoutfb] Warning: unknown HDMI transmitter configuration (see vpoutfb.conf; configuration->\"%s\")", value );
                break;

            case VPOUT_OPT_ENABLE:
                if ( strstr( value, "lcd_sync_fix" ) != NULL ) {
                    disp_printf( adapter, "[vpoutfb] Configuration: LCD sync generation fix enabled" );
                    vpout->enabled |= CONFIG_ENABLE_LCD_SYNC_FIX;
                }
                break;

            case VPOUT_OPT_VERBOSE:
                if ( strstr( value, "silent" ) != NULL ) {
                    disp_printf( adapter, "[vpoutfb] Configuration: \"silent\" output level" );
                    verbose = VPOUT_SLOG_LEVEL_0;
                } else if ( strstr( value, "warn" ) != NULL ) {
                    disp_printf( adapter, "[vpoutfb] Configuration: \"warn\" output level" );
                    verbose = VPOUT_SLOG_LEVEL_WARNING;
                } else if ( strstr( value, "info" ) != NULL ) {
                    disp_printf( adapter, "[vpoutfb] Configuration: \"info\" output level" );
                    verbose = VPOUT_SLOG_LEVEL_INFO;
                } else if ( strstr( value, "debug" ) != NULL ) {
                    disp_printf( adapter, "[vpoutfb] Configuration: \"debug\" output level" );
                    verbose = VPOUT_SLOG_LEVEL_DEBUG;
                } else
                    disp_printf( adapter, "[vpoutfb] Warning: unknown verbosity level (see vpoutfb.conf)" );
                break;

            default:
                disp_printf( adapter, "[vpoutfb] Unknown option %s", c );
                break;
        }
    }

    fclose( fin );

    /* Error detection */
    #define CONFIG_ERROR( text )    { disp_printf( adapter, text ); return (-1); }
        /* base option */
        if ( vpout->registers_base == 0 )
            CONFIG_ERROR( "[vpoutfb] Fatal: unknown display controller registers base phys-address (see vpoutfb.conf)" );
        /* size option */
        if ( vpout->registers_size == 0 )
            disp_printf( adapter, "[vpoutfb] Warning: using display controller default registers size (see vpoutfb.conf)" );
        /* irq option */
        if ( vpout->irq == 0 )
            disp_printf( adapter, "[vpoutfb] Warning: unknown display controller interrupt (see vpoutfb.conf)" );
        /* dispmode option */
        switch ( vpout->display[0] )
        {
            case CONFIG_DISPLAY_PORT_HDMI0:
                if ( !vpout->hdmi[DISPLAY_PORT_INDEX( CONFIG_DISPLAY_PORT_HDMI0 )].assigned )
                    CONFIG_ERROR( "[vpoutfb] Fatal: damaged display controller configuration (see vpoutfb.conf::hdmi option)" );
                break;
        }

    return (0);
}