software/drivers/sd8887/src/wlan/mapp/mlanutl/mlanroamagent.c
/**
 * @brief       Process maintenance of Neighbor list
 *
 * @param       argc    # arguments
 * @param       argv    A pointer to arguments array
 *
 */
@brief       Process maintenance of Neighbor list
@param       argc    # arguments
@param       argv    A pointer to arguments array
@brief Process maintenance of Neighbor list @param argc # arguments @param argv A pointer to arguments array
static int
roamSetNborMaintenance(int argc, char *argv[])
{
	int ret = MLAN_STATUS_SUCCESS;
	struct ifreq ifr;
	t_u8 *buffer = NULL, *pos = NULL;
	t_u32 cmd_len = 0, cmd_header_len;
	struct eth_priv_cmd *cmd = NULL;
	char *valid_cmds[] = { "blacklist", "clear" };
	int i = 0, j = 0, k = 0;
	unsigned int mac[ETH_ALEN];
	HostCmd_DS_GEN *hostcmd;
	HostCmd_DS_CMD_ROAMAGENT_NEIGHBORLIST_MAINTENANCE *pNborMaintainance;
	if (argv[0] == NULL) {
		puts("\nInsufficient arguments.. \n");
		ret = MLAN_STATUS_FAILURE;
		goto done;
	}
	if (argc != 2) {
		puts("\nIncorrect number of arguments.\n");
		ret = MLAN_STATUS_FAILURE;
		goto done;
	}
	for (i = 0; (unsigned int)i < NELEMENTS(valid_cmds); i++)
		if (!strncmp(valid_cmds[i], argv[j], strlen(valid_cmds[i])))
			break;
	if ((unsigned int)i >= NELEMENTS(valid_cmds)) {
		printf("\nInvalid argument \"%s\"\n\n", argv[0]);
		ret = MLAN_STATUS_FAILURE;
		goto done;
	}
	switch (i) {
	case 0:
		j++;
		sscanf(argv[j], "%2x:%2x:%2x:%2x:%2x:%2x",
		       mac, mac + 1, mac + 2, mac + 3, mac + 4, mac + 5);
		for (k = 0; k < ETH_ALEN; k++) {
			if (*(mac + k) != 0xFF) {
				break;
			}
		}
		if (k == ETH_ALEN) {
			puts("\nBlacklisting a Broadcast address is not allowed");
			ret = MLAN_STATUS_FAILURE;
			goto done;
		}
		break;
	case 1:
		j++;
		if (!strncmp("all", argv[j], strlen("all"))) {
			for (k = 0; k < ETH_ALEN; k++) {
				*(mac + k) = 0xFF;
			}
		} else {
			sscanf(argv[j], "%2x:%2x:%2x:%2x:%2x:%2x",
			       mac, mac + 1, mac + 2, mac + 3, mac + 4,
			       mac + 5);
		}
		break;
	}
	cmd_header_len = strlen(CMD_NXP) + strlen(HOSTCMD);
	buffer = (t_u8 *)malloc(BUFFER_LENGTH);
	if (buffer == NULL) {
		fprintf(stderr, "Cannot alloc memory\n");
		ret = ENOMEM;
		goto done;
	}
	memset(buffer, 0, BUFFER_LENGTH);
	cmd = (struct eth_priv_cmd *)malloc(sizeof(struct eth_priv_cmd));
	if (!cmd) {
		printf("ERR:Cannot allocate buffer for command!\n");
		ret = ENOMEM;
		goto done;
	}
#ifdef USERSPACE_32BIT_OVER_KERNEL_64BIT
	memset(cmd, 0, sizeof(struct eth_priv_cmd));
	memcpy(&cmd->buf, &buffer, sizeof(buffer));
#else
	cmd->buf = buffer;
#endif
	cmd->used_len = 0;
	cmd->total_len = BUFFER_LENGTH;
	strncpy((char *)buffer, CMD_NXP, strlen(CMD_NXP));
	strncpy((char *)buffer + strlen(CMD_NXP), HOSTCMD, strlen(HOSTCMD));
	hostcmd = (HostCmd_DS_GEN *)(buffer + cmd_header_len + sizeof(t_u32));
	pos = (t_u8 *)hostcmd + S_DS_GEN;
	pNborMaintainance
		= (HostCmd_DS_CMD_ROAMAGENT_NEIGHBORLIST_MAINTENANCE *)pos;
	cmd_len = S_DS_GEN +
		sizeof(HostCmd_DS_CMD_ROAMAGENT_NEIGHBORLIST_MAINTENANCE);
	hostcmd->command
		= cpu_to_le16(HostCmd_CMD_ROAMAGENT_NEIGHBORLIST_MAINTENANCE);
	hostcmd->size = cpu_to_le16(cmd_len);
	hostcmd->seq_num = 0;
	hostcmd->result = 0;
	pNborMaintainance->action = ((i == 0) ? HostCmd_ACT_ADD_TO_BLACKLIST :
				     HostCmd_ACT_REMOVE_FROM_BLACKLIST);
	pNborMaintainance->action = cpu_to_le16(pNborMaintainance->action);
	for (k = 0; k < ETH_ALEN; k++) {
		pNborMaintainance->BSSID[k] = *(mac + k);
	}
	memcpy(buffer + cmd_header_len, &cmd_len, sizeof(t_u32));
	memset(&ifr, 0, sizeof(ifr));
	strncpy(ifr.ifr_ifrn.ifrn_name, dev_name, strlen(dev_name));
	ifr.ifr_ifru.ifru_data = (void *)cmd;
	if (ioctl(sockfd, MLAN_ETH_PRIV, &ifr)) {
		perror("ioctl[neighborlist maintain]");
		printf("ERR:Command sending failed!\n");
		ret = -EFAULT;
		goto done;
	}
	if (le16_to_cpu(hostcmd->result)) {
		printf("\nHostCmd Error: ReturnCode=%#04x, Result=%#04x\n\n",
		       le16_to_cpu(hostcmd->command),
		       le16_to_cpu(hostcmd->result));
	} else {
		printf("\nHostCmd Success: ReturnCode=%#04x, Result=%#04x\n\n",
		       le16_to_cpu(hostcmd->command),
		       le16_to_cpu(hostcmd->result));
	}
done:
	if (buffer)
		free(buffer);
	if (cmd)
		free(cmd);
	return ret;
}
static int roamSetNborMaintenance ( int argc , char * argv [ ] ) { int ret = MLAN_STATUS_SUCCESS ; struct ifreq ifr ; t_u8 * buffer = NULL , * pos = NULL ; t_u32 cmd_len = 0 , cmd_header_len ; struct eth_priv_cmd * cmd = NULL ; char * valid_cmds [ ] = { " " , " " } ; int i = 0 , j = 0 , k = 0 ; unsigned int mac [ ETH_ALEN ] ; HostCmd_DS_GEN * hostcmd ; HostCmd_DS_CMD_ROAMAGENT_NEIGHBORLIST_MAINTENANCE * pNborMaintainance ; if ( argv [ 0 ] == NULL ) { puts ( " \n \n " ) ; ret = MLAN_STATUS_FAILURE ; goto done ; } if ( argc != 2 ) { puts ( " \n \n " ) ; ret = MLAN_STATUS_FAILURE ; goto done ; } for ( i = 0 ; ( unsigned int ) i < NELEMENTS ( valid_cmds ) ; i ++ ) if ( ! strncmp ( valid_cmds [ i ] , argv [ j ] , strlen ( valid_cmds [ i ] ) ) ) break ; if ( ( unsigned int ) i >= NELEMENTS ( valid_cmds ) ) { printf ( " \n \" \" \n \n " , argv [ 0 ] ) ; ret = MLAN_STATUS_FAILURE ; goto done ; } switch ( i ) { case 0 : j ++ ; sscanf ( argv [ j ] , " " , mac , mac + 1 , mac + 2 , mac + 3 , mac + 4 , mac + 5 ) ; for ( k = 0 ; k < ETH_ALEN ; k ++ ) { if ( * ( mac + k ) != 0xFF ) { break ; } } if ( k == ETH_ALEN ) { puts ( " \n " ) ; ret = MLAN_STATUS_FAILURE ; goto done ; } break ; case 1 : j ++ ; if ( ! strncmp ( " " , argv [ j ] , strlen ( " " ) ) ) { for ( k = 0 ; k < ETH_ALEN ; k ++ ) { * ( mac + k ) = 0xFF ; } } else { sscanf ( argv [ j ] , " " , mac , mac + 1 , mac + 2 , mac + 3 , mac + 4 , mac + 5 ) ; } break ; } cmd_header_len = strlen ( CMD_NXP ) + strlen ( HOSTCMD ) ; buffer = ( t_u8 * ) malloc ( BUFFER_LENGTH ) ; if ( buffer == NULL ) { fprintf ( stderr , " \n " ) ; ret = ENOMEM ; goto done ; } memset ( buffer , 0 , BUFFER_LENGTH ) ; cmd = ( struct eth_priv_cmd * ) malloc ( sizeof ( struct eth_priv_cmd ) ) ; if ( ! cmd ) { printf ( " \n " ) ; ret = ENOMEM ; goto done ; } #ifdef USERSPACE_32BIT_OVER_KERNEL_64BIT memset ( cmd , 0 , sizeof ( struct eth_priv_cmd ) ) ; memcpy ( & cmd -> buf , & buffer , sizeof ( buffer ) ) ; #else cmd -> buf = buffer ; #endif cmd -> used_len = 0 ; cmd -> total_len = BUFFER_LENGTH ; strncpy ( ( char * ) buffer , CMD_NXP , strlen ( CMD_NXP ) ) ; strncpy ( ( char * ) buffer + strlen ( CMD_NXP ) , HOSTCMD , strlen ( HOSTCMD ) ) ; hostcmd = ( HostCmd_DS_GEN * ) ( buffer + cmd_header_len + sizeof ( t_u32 ) ) ; pos = ( t_u8 * ) hostcmd + S_DS_GEN ; pNborMaintainance = ( HostCmd_DS_CMD_ROAMAGENT_NEIGHBORLIST_MAINTENANCE * ) pos ; cmd_len = S_DS_GEN + sizeof ( HostCmd_DS_CMD_ROAMAGENT_NEIGHBORLIST_MAINTENANCE ) ; hostcmd -> command = cpu_to_le16 ( HostCmd_CMD_ROAMAGENT_NEIGHBORLIST_MAINTENANCE ) ; hostcmd -> size = cpu_to_le16 ( cmd_len ) ; hostcmd -> seq_num = 0 ; hostcmd -> result = 0 ; pNborMaintainance -> action = ( ( i == 0 ) ? HostCmd_ACT_ADD_TO_BLACKLIST : HostCmd_ACT_REMOVE_FROM_BLACKLIST ) ; pNborMaintainance -> action = cpu_to_le16 ( pNborMaintainance -> action ) ; for ( k = 0 ; k < ETH_ALEN ; k ++ ) { pNborMaintainance -> BSSID [ k ] = * ( mac + k ) ; } memcpy ( buffer + cmd_header_len , & cmd_len , sizeof ( t_u32 ) ) ; memset ( & ifr , 0 , sizeof ( ifr ) ) ; strncpy ( ifr . ifr_ifrn . ifrn_name , dev_name , strlen ( dev_name ) ) ; ifr . ifr_ifru . ifru_data = ( void * ) cmd ; if ( ioctl ( sockfd , MLAN_ETH_PRIV , & ifr ) ) { perror ( " " ) ; printf ( " \n " ) ; ret = - EFAULT ; goto done ; } if ( le16_to_cpu ( hostcmd -> result ) ) { printf ( " \n \n \n " , le16_to_cpu ( hostcmd -> command ) , le16_to_cpu ( hostcmd -> result ) ) ; } else { printf ( " \n \n \n " , le16_to_cpu ( hostcmd -> command ) , le16_to_cpu ( hostcmd -> result ) ) ; } done : if ( buffer ) free ( buffer ) ; if ( cmd ) free ( cmd ) ; return ret ; }
@brief       Process maintenance of Neighbor list
 @param       argc    # arguments
 @param       argv    A pointer to arguments array
@brief Process maintenance of Neighbor list @param argc # arguments @param argv A pointer to arguments array
/** blacklist */ /** clear */ /* Fill up buffer */ /* buffer = MRVL_CMD<cmd> */ /* buffer = MRVL_CMD<cmd><hostcmd_size><HostCmd_DS_GEN><CMD_DS> */ /* Point after host command header */ /* Put buffer length */ /* Initialize the ifr structure */ /* Perform ioctl */