//******************************************************************************
//*this code is protected by the GNU affero GPLv3
//*author:Sylvain BERTRAND <sylvain.bertrand AT gmail dot com>
//*                        <digital.ragnarok AT gmail dot com>
//******************************************************************************
#include <ulinux/compiler_types.h>
#include <ulinux/types.h>
#include <ulinux/stat.h>
#include <ulinux/error.h>
#include <ulinux/utils/ascii/string/conv/decimal/decimal.h>
#include <ulinux/utils/mem.h>
#include <ulinux/sysc.h>

#ifndef QUIET
#include <stdarg.h>
#include <ulinux/utils/ascii/string/vsprintf.h>
#endif

#include "globals.h"

static void root_mknod(k_u16 major,k_u32 minor)
{
  OUT(PRE "creating root device node:%s major=%u minor=%u...","/dev/" ROOT,
      major,minor);
  k_l r=sysc(mknod,3,"/dev/" ROOT,K_S_IFBLK|K_S_IRUSR|K_S_IWUSR|K_S_IRGRP
                                           |K_S_IWGRP,
                     (minor&0xff)|(major<<8)|((minor&~0xff)<< 12));
  if(K_ISERR(r)){
    OUT("ERROR(%ld):unable to create the root node\n",r);
    sysc(exit_group,1,-1);
  }
  OUTC("done\n");
}

static k_ut hdr_action_is_add(k_u8 *hdr)
{
  #define HDR_ACTION_ADD "add@"
  if(u_memcmp(hdr,(k_u8*)HDR_ACTION_ADD,sizeof(HDR_ACTION_ADD)-1)) return 0;
  return 1;
}

static void hdr_skip(k_u8 **p)
{
  while(*(*p)++);
}
#define var_skip hdr_skip

static k_ut key_is_subsystem(k_u8 *p)
{
  #define KEY_SUBSYSTEM "SUBSYSTEM="
  if(u_memcmp(p,(k_u8*)KEY_SUBSYSTEM,sizeof(KEY_SUBSYSTEM)-1)) return 0;
  return 1;
}

static k_ut key_is_devname(k_u8 *p)
{
  #define KEY_DEVNAME "DEVNAME="
  if(u_memcmp(p,(k_u8*)KEY_DEVNAME,sizeof(KEY_DEVNAME)-1)) return 0;
  return 1;
}

static k_ut key_is_major(k_u8 *p)
{
  #define KEY_MAJOR "MAJOR="
  if(u_memcmp(p,(k_u8*)KEY_MAJOR,sizeof(KEY_MAJOR)-1)) return 0;
  return 1;
}

static k_ut key_is_minor(k_u8 *p)
{
  #define KEY_MINOR "MINOR="
  if(u_memcmp(p,(k_u8*)KEY_MINOR,sizeof(KEY_MINOR)-1)) return 0;
  return 1;
}

static void move_to_value(k_u8 **p)
{
  while(*(*p)++!='=');
}

static k_ut value_is_block(k_u8 *p)
{
  #define VALUE_BLOCK "block"
  if(!*p||u_memcmp(p,(k_u8*)VALUE_BLOCK,sizeof(VALUE_BLOCK)-1)) return 0;
  return 1;
}

static void value_skip(k_u8 **p)
{
  while(*(*p)++);
}

static void value_str_consume(k_u8 **p,k_u8 *d)
{
  do *d++=**p; while(*(*p)++);
}

void uevent_process(k_u8 *p,k_i sz)
{
  if(!hdr_action_is_add(p)) return;
  k_u8 *p_end=p+sz;
  hdr_skip(&p);

  k_u8 dev_name[256];
  u_memset(dev_name,0,sizeof(dev_name));
  k_u16 major=0;
  k_u32 minor=0;

  while(p<p_end){
    if(key_is_subsystem(p)){
      move_to_value(&p);
      if(!value_is_block(p)) return;
      else value_skip(&p);
    }else if(key_is_devname(p)){
      move_to_value(&p);
      value_str_consume(&p,dev_name);
    }else if(key_is_major(p)){
	  move_to_value(&p);
      if(!u_a_strict_dec2u16(&major,p)){
        OUT(PRE "ERROR:unable to convert major '%s'\n",p);
        sysc(exit_group,1,-1);
      }
      value_skip(&p);
    }else if(key_is_minor(p)){
      move_to_value(&p);
      if(!u_a_strict_dec2u32(&minor,p)){
        OUT(PRE "ERROR:unable to convert minor '%s'\n",p);
        sysc(exit_group,1,-1);
      }
      value_skip(&p);
    }else var_skip(&p);
  }

  if(!u_memcmp(dev_name,(k_u8*)ROOT,sizeof(ROOT)-1)){
     root_mknod(major,minor);
  }
}