WebSVN – HelenOS – Diff – /branches/network/uspace/srv/net/netif/dp8390/dp8390_module.c


/*
 * Copyright (c) 2009 Lukas Mejdrech
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */
 
/** @addtogroup dp8390
 *  @{
 */
 
/** @file
 */
 
#include <assert.h>
#include <ddi.h>
#include <errno.h>
#include <malloc.h>
//#include <stdio.h>
#include <ipc/ipc.h>
#include <ipc/services.h>
 
#include "../../err.h"
#include "../../messages.h"
#include "../../modules.h"
 
#include "../../structures/packet/packet_client.h"
#include "../../structures/measured_strings.h"
 
#include "../../include/device.h"
#include "../../include/nil_messages.h"
 
#include "../netif.h"
#include "../netif_interface.h"
 
#include "dp8390.h"
#include "dp8390_drv.h"
 
#include "dp8390_port.h"
 
#define NAME    "dp8390 network interface"
 
#define IRQ_GET_DEVICE( call )          ( device_id_t ) IPC_GET_METHOD( * call )
#define IPC_GET_ISR( call )             ( int ) IPC_GET_ARG2( * call )
 
static irq_cmd_t    dp8390_cmds[] = {
    {   .cmd = CMD_PIO_READ_8,
        .addr = NULL,
        .dstarg = 2
    },
    {
        .cmd = CMD_PREDICATE,
        .value = 2,
        .srcarg = 2
    },
    {   .cmd = CMD_PIO_WRITE_8,
        .addr = NULL,
        .srcarg = 2
    },
    {
        .cmd = CMD_ACCEPT
    }
};
 
static irq_code_t   dp8390_code = {
    sizeof( dp8390_cmds ) / sizeof( irq_cmd_t ),
    dp8390_cmds
};
 
netif_globals_t netif_globals;
 
void    netif_print_name( void );
 
void    irq_handler( ipc_callid_t iid, ipc_call_t * call );
int change_state( device_ref device, device_state_t state );
 
int netif_specific_message( ipc_callid_t callid, ipc_call_t * call, ipc_call_t * answer, int * answer_count ){
    return ENOTSUP;
}
 
int netif_get_device_stats( device_id_t device_id, device_stats_ref stats ){
    ERROR_DECLARE;
 
    device_ref      device;
    eth_stat_t *    de_stat;
 
    if( ! stats ) return EBADMEM;
    ERROR_PROPAGATE( find_device( device_id, & device ));
    de_stat = & (( dpeth_t * ) device->specific )->de_stat;
    null_device_stats( stats );
    stats->rx_errors = de_stat->ets_recvErr;
    stats->tx_errors = de_stat->ets_sendErr;
    stats->rx_crc_errors = de_stat->ets_CRCerr;
    stats->rx_frame_errors = de_stat->ets_frameAll;
    stats->rx_missed_errors = de_stat->ets_missedP;
    stats->rx_packets = de_stat->ets_packetR;
    stats->tx_packets = de_stat->ets_packetT;
    stats->collisions = de_stat->ets_collision;
    stats->tx_aborted_errors = de_stat->ets_transAb;
    stats->tx_carrier_errors = de_stat->ets_carrSense;
    stats->tx_heartbeat_errors = de_stat->ets_CDheartbeat;
    stats->tx_window_errors = de_stat->ets_OWC;
    return EOK;
}
 
void netif_print_name( void ){
    printf( "%s", NAME );
}
 
int netif_get_addr_message( device_id_t device_id, measured_string_ref address ){
    ERROR_DECLARE;
 
    device_ref  device;
 
    if( ! address ) return EBADMEM;
    ERROR_PROPAGATE( find_device( device_id, & device ));
    address->value = ( char * ) ( & (( dpeth_t * ) device->specific )->de_address );
    address->length = CONVERT_SIZE( ether_addr_t, char, 1 );
    return EOK;
}
 
void irq_handler( ipc_callid_t iid, ipc_call_t * call )
{
//  int irq;
    device_ref  device;
    dpeth_t *   dep;
    packet_t    received;
    device_id_t device_id;
    int         phone;
 
    device_id = IRQ_GET_DEVICE( call );
//  printf( "\ndevice %d - irq %x", device_id, IPC_GET_ISR( call ));
    rwlock_write_lock( & netif_globals.lock );
    if( find_device( device_id, & device ) != EOK ){
        rwlock_write_unlock( & netif_globals.lock );
        return;
    }
    dep = ( dpeth_t * ) device->specific;
//  printf( "\ndev %d, irq %x\n", device->device_id, IPC_GET_ISR( call ));
    if ( dep->de_mode != DEM_ENABLED){
//      continue;
        rwlock_write_unlock( & netif_globals.lock );
        return;
    }
    assert( dep->de_flags & DEF_ENABLED);
//  irq= dep.de_irq;
//  assert(irq >= 0 && irq < NR_IRQ_VECTORS);
//      if ( dep->de_int_pending || 1)
//      {
        dep->de_int_pending= 0;
        dp_check_ints( dep );
//      do_int(dep);
/*      r= sys_irqenable(&dep->de_hook);
        if (r != OK)
        {
            panic("DP8390",
            "unable enable interrupts", r);
        }
*///    }
    if( dep->received_queue ){
        received = dep->received_queue;
        phone = device->nil_phone;
        dep->received_queue = NULL;
        rwlock_write_unlock( & netif_globals.lock );
        nil_received_msg( phone, device_id, received, NULL );
    }else{
        rwlock_write_unlock( & netif_globals.lock );
    }
    ipc_answer_0( iid, EOK );
}
 
int netif_probe_auto_message( void ){
    return ENOTSUP;
}
 
int netif_probe_message( device_id_t device_id, int irq, int io ){
    ERROR_DECLARE;
 
    device_ref  device;
    dpeth_t *   dep;
 
    printf( "\n" );
    device = ( device_ref ) malloc( sizeof( device_t ));
    if( ! device ) return ENOMEM;
    dep = ( dpeth_t * ) malloc( sizeof( dpeth_t ));
    if( ! dep ){
        free( device );
        return ENOMEM;
    }
    bzero( device, sizeof( device_t ));
    bzero( dep, sizeof( dpeth_t ));
    device->device_id = device_id;
    device->nil_phone = -1;
    device->specific = ( void * ) dep;
    device->state = NETIF_STOPPED;
 
    dep->de_irq = irq;
    dep->de_mode = DEM_DISABLED;
    //TODO address?
    if( ERROR_OCCURRED( pio_enable(( void * ) io, DP8390_IO_SIZE, ( void ** ) & dep->de_base_port ))
    || ERROR_OCCURRED( do_probe( dep ))){
        free( dep );
        free( device );
        return ERROR_CODE;
    }
    if( ERROR_OCCURRED( device_map_add( & netif_globals.device_map, device->device_id, device ))){
        free( dep );
        free( device );
        return ERROR_CODE;
    }
    return EOK;
}
 
int netif_send_message( device_id_t device_id, packet_t packet, services_t sender ){
    ERROR_DECLARE;
 
    device_ref  device;
    dpeth_t *   dep;
    packet_t    next;
 
    uint8_t *   data;
    data = packet_get_data( packet );
    printf( "\nSending packet:\n\tid\t= %d\n\tlength\t= %d\n\tdata\t= %.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX\n\t\t%.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX", packet_get_id( packet ), packet_get_data_length( packet ), data[ 0 ], data[ 1 ], data[ 2 ], data[ 3 ], data[ 4 ], data[ 5 ], data[ 6 ], data[ 7 ], data[ 8 ], data[ 9 ], data[ 10 ], data[ 11 ], data[ 12 ], data[ 13 ], data[ 14 ], data[ 15 ], data[ 16 ], data[ 17 ], data[ 18 ], data[ 19 ], data[ 20 ], data[ 21 ], data[ 22 ], data[ 23 ], data[ 24 ], data[ 25 ], data[ 26 ], data[ 27 ], data[ 28 ], data[ 29 ], data[ 30 ], data[ 31 ], data[ 32 ], data[ 33 ], data[ 34 ], data[ 35 ], data[ 36 ], data[ 37 ], data[ 38 ], data[ 39 ], data[ 40 ], data[ 41 ], data[ 42 ], data[ 43 ], data[ 44 ], data[ 45 ], data[ 46 ], data[ 47 ], data[ 48 ], data[ 49 ], data[ 50 ], data[ 51 ], data[ 52 ], data[ 53 ], data[ 54 ], data[ 55 ], data[ 56 ], data[ 57 ], data[ 58 ], data[ 59 ] );
 
    ERROR_PROPAGATE( find_device( device_id, & device ));
    dep = ( dpeth_t * ) device->specific;
    // process packet queue
    do{
        next = pq_detach( packet );
        if( do_pwrite( dep, packet, FALSE ) != EBUSY ){
            netif_pq_release( packet_get_id( packet ));
        }
        packet = next;
    }while( packet );
    return EOK;
}
 
int netif_start_message( device_ref device ){
    ERROR_DECLARE;
 
 
    dpeth_t *   dep;
 
 
    if( device->state != NETIF_ACTIVE ){
        dep = ( dpeth_t * ) device->specific;
        dp8390_cmds[ 0 ].addr = ( void * ) ( uint32_t ) ( dep->de_dp8390_port + DP_ISR );
        dp8390_cmds[ 2 ].addr = dp8390_cmds[ 0 ].addr;
        ERROR_PROPAGATE( ipc_register_irq( dep->de_irq, device->device_id, device->device_id, & dp8390_code ));
        if( ERROR_OCCURRED( do_init( dep, DL_BROAD_REQ ))){
            ipc_unregister_irq( dep->de_irq, device->device_id );
            return ERROR_CODE;
        }
        return change_state( device, NETIF_ACTIVE );
    }
    return EOK;
}
 
int netif_stop_message( device_ref device ){
 
 
 
    dpeth_t *   dep;
 
 
    if( device->state != NETIF_STOPPED ){
        dep = ( dpeth_t * ) device->specific;
        do_stop( dep );
        ipc_unregister_irq( dep->de_irq, device->device_id );
        return change_state( device, NETIF_STOPPED );
    }
    return EOK;
}
 
int change_state( device_ref device, device_state_t state ){
    device->state = state;
 
    printf( "\nState changed to %s", ( state == NETIF_ACTIVE ) ? "ACTIVE" : "STOPPED" );
    return state;
}
 
int netif_initialize( void ){
    ipcarg_t    phonehash;
 
    async_set_interrupt_received( irq_handler );
 
    return REGISTER_ME( SERVICE_DP8390, & phonehash );
}
 
 
 
 
 
 
 
/** @}
 */
 

Rev 4243	Rev 4261
1	/*	1	/*
2	* Copyright (c) 2009 Lukas Mejdrech	2	* Copyright (c) 2009 Lukas Mejdrech
3	* All rights reserved.	3	* All rights reserved.
4	*	4	*
5	* Redistribution and use in source and binary forms, with or without	5	* Redistribution and use in source and binary forms, with or without
6	* modification, are permitted provided that the following conditions	6	* modification, are permitted provided that the following conditions
7	* are met:	7	* are met:
8	*	8	*
9	* - Redistributions of source code must retain the above copyright	9	* - Redistributions of source code must retain the above copyright
10	* notice, this list of conditions and the following disclaimer.	10	* notice, this list of conditions and the following disclaimer.
11	* - Redistributions in binary form must reproduce the above copyright	11	* - Redistributions in binary form must reproduce the above copyright
12	* notice, this list of conditions and the following disclaimer in the	12	* notice, this list of conditions and the following disclaimer in the
13	* documentation and/or other materials provided with the distribution.	13	* documentation and/or other materials provided with the distribution.
14	* - The name of the author may not be used to endorse or promote products	14	* - The name of the author may not be used to endorse or promote products
15	* derived from this software without specific prior written permission.	15	* derived from this software without specific prior written permission.
16	*	16	*
17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES	18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY	23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF	25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.	26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27	*/	27	*/
28		28
29	/** @addtogroup dp8390	29	/** @addtogroup dp8390
30	* @{	30	* @{
31	*/	31	*/
32		32
33	/** @file	33	/** @file
34	*/	34	*/
35		35
36	#include <assert.h>	36	#include <assert.h>
37	#include <ddi.h>	37	#include <ddi.h>
38	#include <errno.h>	38	#include <errno.h>
39	#include <malloc.h>	39	#include <malloc.h>
40	//#include <stdio.h>	40	//#include <stdio.h>
41	#include <ipc/ipc.h>	41	#include <ipc/ipc.h>
42	#include <ipc/services.h>	42	#include <ipc/services.h>
43		43
44	#include "../../err.h"	44	#include "../../err.h"
45	#include "../../messages.h"	45	#include "../../messages.h"
46	#include "../../modules.h"	46	#include "../../modules.h"
47		47
48	#include "../../structures/packet/packet_client.h"	48	#include "../../structures/packet/packet_client.h"
49	#include "../../structures/measured_strings.h"	49	#include "../../structures/measured_strings.h"
50		50
51	#include "../../include/device.h"	51	#include "../../include/device.h"
-		52	#include "../../include/nil_messages.h"
52		53
53	#include "../netif.h"	54	#include "../netif.h"
54	#include "../netif_interface.h"	55	#include "../netif_interface.h"
55		56
56	#include "dp8390.h"	57	#include "dp8390.h"
57	#include "dp8390_drv.h"	58	#include "dp8390_drv.h"
58	#include "dp8390_module.h"	-
59	#include "dp8390_port.h"	59	#include "dp8390_port.h"
60		60
61	#define NAME "dp8390 network interface"	61	#define NAME "dp8390 network interface"
62		62
63	#define IPC_GET_DEVICE( call ) ( device_id_t ) IPC_GET_METHOD( * call )	63	#define IRQ_GET_DEVICE( call ) ( device_id_t ) IPC_GET_METHOD( * call )
64	#define IPC_GET_ISR( call ) ( int ) IPC_GET_ARG2( * call )	64	#define IPC_GET_ISR( call ) ( int ) IPC_GET_ARG2( * call )
65		65
66	static irq_cmd_t dp8390_cmds[] = {	66	static irq_cmd_t dp8390_cmds[] = {
67	{ .cmd = CMD_PIO_READ_8,	67	{ .cmd = CMD_PIO_READ_8,
68	.addr = NULL,	68	.addr = NULL,
69	.dstarg = 2	69	.dstarg = 2
70	},	70	},
71	{	71	{
72	.cmd = CMD_PREDICATE,	72	.cmd = CMD_PREDICATE,
73	.value = 2,	73	.value = 2,
74	.srcarg = 2	74	.srcarg = 2
75	},	75	},
76	{ .cmd = CMD_PIO_WRITE_8,	76	{ .cmd = CMD_PIO_WRITE_8,
77	.addr = NULL,	77	.addr = NULL,
78	.srcarg = 2	78	.srcarg = 2
79	},	79	},
80	{	80	{
81	.cmd = CMD_ACCEPT	81	.cmd = CMD_ACCEPT
82	}	82	}
83	};	83	};
84		84
85	static irq_code_t dp8390_code = {	85	static irq_code_t dp8390_code = {
86	sizeof( dp8390_cmds ) / sizeof( irq_cmd_t ),	86	sizeof( dp8390_cmds ) / sizeof( irq_cmd_t ),
87	dp8390_cmds	87	dp8390_cmds
88	};	88	};
89		89
90	netif_globals_t netif_globals;	90	netif_globals_t netif_globals;
91		91
92	void netif_print_name( void );	92	void netif_print_name( void );
93		93
94	void irq_handler( ipc_callid_t iid, ipc_call_t * call );	94	void irq_handler( ipc_callid_t iid, ipc_call_t * call );
95	void change_state( device_ref device, device_state_t state );	95	int change_state( device_ref device, device_state_t state );
96		96
97	int netif_specific_message( ipc_callid_t callid, ipc_call_t * call, ipc_call_t * answer, int * answer_count ){	97	int netif_specific_message( ipc_callid_t callid, ipc_call_t * call, ipc_call_t * answer, int * answer_count ){
98	return ENOTSUP;	98	return ENOTSUP;
99	}	99	}
100		100
101	int netif_get_device_stats( device_id_t device_id, device_stats_ref stats ){	101	int netif_get_device_stats( device_id_t device_id, device_stats_ref stats ){
102	ERROR_DECLARE;	102	ERROR_DECLARE;
103		103
104	device_ref device;	104	device_ref device;
105	eth_stat_t * de_stat;	105	eth_stat_t * de_stat;
106		106
107	if( ! stats ) return EBADMEM;	107	if( ! stats ) return EBADMEM;
108	ERROR_PROPAGATE( find_device( device_id, & device ));	108	ERROR_PROPAGATE( find_device( device_id, & device ));
109	de_stat = & (( dpeth_t * ) device->specific )->de_stat;	109	de_stat = & (( dpeth_t * ) device->specific )->de_stat;
110	null_device_stats( stats );	110	null_device_stats( stats );
111	stats->rx_errors = de_stat->ets_recvErr;	111	stats->rx_errors = de_stat->ets_recvErr;
112	stats->tx_errors = de_stat->ets_sendErr;	112	stats->tx_errors = de_stat->ets_sendErr;
113	stats->rx_crc_errors = de_stat->ets_CRCerr;	113	stats->rx_crc_errors = de_stat->ets_CRCerr;
114	stats->rx_frame_errors = de_stat->ets_frameAll;	114	stats->rx_frame_errors = de_stat->ets_frameAll;
115	stats->rx_missed_errors = de_stat->ets_missedP;	115	stats->rx_missed_errors = de_stat->ets_missedP;
116	stats->rx_packets = de_stat->ets_packetR;	116	stats->rx_packets = de_stat->ets_packetR;
117	stats->tx_packets = de_stat->ets_packetT;	117	stats->tx_packets = de_stat->ets_packetT;
118	stats->collisions = de_stat->ets_collision;	118	stats->collisions = de_stat->ets_collision;
119	stats->tx_aborted_errors = de_stat->ets_transAb;	119	stats->tx_aborted_errors = de_stat->ets_transAb;
120	stats->tx_carrier_errors = de_stat->ets_carrSense;	120	stats->tx_carrier_errors = de_stat->ets_carrSense;
121	stats->tx_heartbeat_errors = de_stat->ets_CDheartbeat;	121	stats->tx_heartbeat_errors = de_stat->ets_CDheartbeat;
122	stats->tx_window_errors = de_stat->ets_OWC;	122	stats->tx_window_errors = de_stat->ets_OWC;
123	return EOK;	123	return EOK;
124	}	124	}
125		125
126	void netif_print_name( void ){	126	void netif_print_name( void ){
127	printf( "%s", NAME );	127	printf( "%s", NAME );
128	}	128	}
129		129
130	int netif_get_addr_message( device_id_t device_id, measured_string_ref address ){	130	int netif_get_addr_message( device_id_t device_id, measured_string_ref address ){
131	ERROR_DECLARE;	131	ERROR_DECLARE;
132		132
133	device_ref device;	133	device_ref device;
134		134
135	if( ! address ) return EBADMEM;	135	if( ! address ) return EBADMEM;
136	ERROR_PROPAGATE( find_device( device_id, & device ));	136	ERROR_PROPAGATE( find_device( device_id, & device ));
137	address->value = ( char * ) ( & (( dpeth_t * ) device->specific )->de_address );	137	address->value = ( char * ) ( & (( dpeth_t * ) device->specific )->de_address );
138	address->length = CONVERT_SIZE( ether_addr_t, char, 1 );	138	address->length = CONVERT_SIZE( ether_addr_t, char, 1 );
139	return EOK;	139	return EOK;
140	}	140	}
141		141
142	void irq_handler( ipc_callid_t iid, ipc_call_t * call )	142	void irq_handler( ipc_callid_t iid, ipc_call_t * call )
143	{	143	{
144	// int irq;	144	// int irq;
145	device_ref device;	145	device_ref device;
146	dpeth_t * dep;	146	dpeth_t * dep;
-		147	packet_t received;
-		148	device_id_t device_id;
-		149	int phone;
147		150
-		151	device_id = IRQ_GET_DEVICE( call );
148	printf( "\ndevice %d - irq %x", IPC_GET_DEVICE( call ), IPC_GET_ISR( call ));	152	// printf( "\ndevice %d - irq %x", device_id, IPC_GET_ISR( call ));
-		153	rwlock_write_lock( & netif_globals.lock );
149	if( find_device( IPC_GET_DEVICE( call ), & device ) != EOK ) return;	154	if( find_device( device_id, & device ) != EOK ){
-		155	rwlock_write_unlock( & netif_globals.lock );
-		156	return;
-		157	}
150	dep = ( dpeth_t * ) device->specific;	158	dep = ( dpeth_t * ) device->specific;
151	printf( "\ndev %d, irq %x\n", device->device_id, IPC_GET_ISR( call ));	159	// printf( "\ndev %d, irq %x\n", device->device_id, IPC_GET_ISR( call ));
152	if ( dep->de_mode != DEM_ENABLED)	160	if ( dep->de_mode != DEM_ENABLED){
153	// continue;	161	// continue;
-		162	rwlock_write_unlock( & netif_globals.lock );
154	return;	163	return;
-		164	}
155	assert( dep->de_flags & DEF_ENABLED);	165	assert( dep->de_flags & DEF_ENABLED);
156	// irq= dep.de_irq;	166	// irq= dep.de_irq;
157	// assert(irq >= 0 && irq < NR_IRQ_VECTORS);	167	// assert(irq >= 0 && irq < NR_IRQ_VECTORS);
158	// if ( dep->de_int_pending \|\| 1)	168	// if ( dep->de_int_pending \|\| 1)
159	// {	169	// {
160	dep->de_int_pending= 0;	170	dep->de_int_pending= 0;
161	dp_check_ints( dep );	171	dp_check_ints( dep );
162	// do_int(dep);	172	// do_int(dep);
163	/* r= sys_irqenable(&dep->de_hook);	173	/* r= sys_irqenable(&dep->de_hook);
164	if (r != OK)	174	if (r != OK)
165	{	175	{
166	panic("DP8390",	176	panic("DP8390",
167	"unable enable interrupts", r);	177	"unable enable interrupts", r);
168	}	178	}
169	*/// }	179	*/// }
-		180	if( dep->received_queue ){
-		181	received = dep->received_queue;
-		182	phone = device->nil_phone;
-		183	dep->received_queue = NULL;
-		184	rwlock_write_unlock( & netif_globals.lock );
-		185	nil_received_msg( phone, device_id, received, NULL );
-		186	}else{
-		187	rwlock_write_unlock( & netif_globals.lock );
-		188	}
170	ipc_answer_0( iid, EOK );	189	ipc_answer_0( iid, EOK );
171	}	190	}
172		191
173	int netif_probe_auto_message( void ){	192	int netif_probe_auto_message( void ){
174	return ENOTSUP;	193	return ENOTSUP;
175	}	194	}
176		195
177	int netif_probe_message( device_id_t device_id, int irq, int io ){	196	int netif_probe_message( device_id_t device_id, int irq, int io ){
178	ERROR_DECLARE;	197	ERROR_DECLARE;
179		198
180	device_ref device;	199	device_ref device;
181	dpeth_t * dep;	200	dpeth_t * dep;
182		201
183	printf( "\n" );	202	printf( "\n" );
184	device = ( device_ref ) malloc( sizeof( device_t ));	203	device = ( device_ref ) malloc( sizeof( device_t ));
185	if( ! device ) return ENOMEM;	204	if( ! device ) return ENOMEM;
186	dep = ( dpeth_t * ) malloc( sizeof( dpeth_t ));	205	dep = ( dpeth_t * ) malloc( sizeof( dpeth_t ));
187	if( ! dep ){	206	if( ! dep ){
188	free( device );	207	free( device );
189	return ENOMEM;	208	return ENOMEM;
190	}	209	}
191	bzero( device, sizeof( device_t ));	210	bzero( device, sizeof( device_t ));
192	bzero( dep, sizeof( dpeth_t ));	211	bzero( dep, sizeof( dpeth_t ));
193	device->device_id = device_id;	212	device->device_id = device_id;
194	device->nil_phone = -1;	213	device->nil_phone = -1;
195	device->specific = ( void * ) dep;	214	device->specific = ( void * ) dep;
196	device->state = NETIF_STOPPED;	215	device->state = NETIF_STOPPED;
197	dep->parent = device;	-
198	dep->de_irq = irq;	216	dep->de_irq = irq;
199	dep->de_mode = DEM_DISABLED;	217	dep->de_mode = DEM_DISABLED;
200	//TODO address?	218	//TODO address?
201	if( ERROR_OCCURRED( pio_enable(( void * ) io, DP8390_IO_SIZE, ( void ** ) & dep->de_base_port ))	219	if( ERROR_OCCURRED( pio_enable(( void * ) io, DP8390_IO_SIZE, ( void ** ) & dep->de_base_port ))
202	\|\| ERROR_OCCURRED( do_probe( dep ))){	220	\|\| ERROR_OCCURRED( do_probe( dep ))){
203	free( dep );	221	free( dep );
204	free( device );	222	free( device );
205	return ERROR_CODE;	223	return ERROR_CODE;
206	}	224	}
207	if( ERROR_OCCURRED( device_map_add( & netif_globals.device_map, device->device_id, device ))){	225	if( ERROR_OCCURRED( device_map_add( & netif_globals.device_map, device->device_id, device ))){
208	free( dep );	226	free( dep );
209	free( device );	227	free( device );
210	return ERROR_CODE;	228	return ERROR_CODE;
211	}	229	}
212	return EOK;	230	return EOK;
213	}	231	}
214		232
215	int netif_send_message( device_id_t device_id, packet_t packet ){	233	int netif_send_message( device_id_t device_id, packet_t packet, services_t sender ){
216	ERROR_DECLARE;	234	ERROR_DECLARE;
217		235
218	device_ref device;	236	device_ref device;
219	dpeth_t * dep;	237	dpeth_t * dep;
220	packet_t next;	238	packet_t next;
221		239
222	uint8_t * data;	240	uint8_t * data;
223	data = packet_get_data( packet );	241	data = packet_get_data( packet );
224	printf( "\nSending packet:\n\tid\t= %d\n\tlength\t= %d\n\tdata\t= %.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX\n\t\t%.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX", packet_get_id( packet ), packet_get_data_length( packet ), data[ 0 ], data[ 1 ], data[ 2 ], data[ 3 ], data[ 4 ], data[ 5 ], data[ 6 ], data[ 7 ], data[ 8 ], data[ 9 ], data[ 10 ], data[ 11 ], data[ 12 ], data[ 13 ], data[ 14 ], data[ 15 ], data[ 16 ], data[ 17 ], data[ 18 ], data[ 19 ], data[ 20 ], data[ 21 ], data[ 22 ], data[ 23 ], data[ 24 ], data[ 25 ], data[ 26 ], data[ 27 ], data[ 28 ], data[ 29 ], data[ 30 ], data[ 31 ], data[ 32 ], data[ 33 ], data[ 34 ], data[ 35 ], data[ 36 ], data[ 37 ], data[ 38 ], data[ 39 ], data[ 40 ], data[ 41 ], data[ 42 ], data[ 43 ], data[ 44 ], data[ 45 ], data[ 46 ], data[ 47 ], data[ 48 ], data[ 49 ], data[ 50 ], data[ 51 ], data[ 52 ], data[ 53 ], data[ 54 ], data[ 55 ], data[ 56 ], data[ 57 ], data[ 58 ], data[ 59 ] );	242	printf( "\nSending packet:\n\tid\t= %d\n\tlength\t= %d\n\tdata\t= %.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX\n\t\t%.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX:%.2hhX %.2hhX %.2hhX %.2hhX", packet_get_id( packet ), packet_get_data_length( packet ), data[ 0 ], data[ 1 ], data[ 2 ], data[ 3 ], data[ 4 ], data[ 5 ], data[ 6 ], data[ 7 ], data[ 8 ], data[ 9 ], data[ 10 ], data[ 11 ], data[ 12 ], data[ 13 ], data[ 14 ], data[ 15 ], data[ 16 ], data[ 17 ], data[ 18 ], data[ 19 ], data[ 20 ], data[ 21 ], data[ 22 ], data[ 23 ], data[ 24 ], data[ 25 ], data[ 26 ], data[ 27 ], data[ 28 ], data[ 29 ], data[ 30 ], data[ 31 ], data[ 32 ], data[ 33 ], data[ 34 ], data[ 35 ], data[ 36 ], data[ 37 ], data[ 38 ], data[ 39 ], data[ 40 ], data[ 41 ], data[ 42 ], data[ 43 ], data[ 44 ], data[ 45 ], data[ 46 ], data[ 47 ], data[ 48 ], data[ 49 ], data[ 50 ], data[ 51 ], data[ 52 ], data[ 53 ], data[ 54 ], data[ 55 ], data[ 56 ], data[ 57 ], data[ 58 ], data[ 59 ] );
225		243
226	ERROR_PROPAGATE( find_device( device_id, & device ));	244	ERROR_PROPAGATE( find_device( device_id, & device ));
227	dep = ( dpeth_t * ) device->specific;	245	dep = ( dpeth_t * ) device->specific;
228	// process packet queue	246	// process packet queue
229	do{	247	do{
230	next = pq_detach( packet );	248	next = pq_detach( packet );
231	if( do_pwrite( dep, packet, FALSE ) != EBUSY ){	249	if( do_pwrite( dep, packet, FALSE ) != EBUSY ){
232	netif_pq_release( packet_get_id( packet ));	250	netif_pq_release( packet_get_id( packet ));
233	}	251	}
234	packet = next;	252	packet = next;
235	}while( packet );	253	}while( packet );
236	return EOK;	254	return EOK;
237	}	255	}
238		256
239	int netif_start_message( device_id_t device_id ){	257	int netif_start_message( device_ref device ){
240	ERROR_DECLARE;	258	ERROR_DECLARE;
241		259
242	device_ref device;	-
243	dpeth_t * dep;	260	dpeth_t * dep;
244		261
245	ERROR_PROPAGATE( find_device( device_id, & device ));	-
246	if( device->state != NETIF_ACTIVE ){	262	if( device->state != NETIF_ACTIVE ){
247	dep = ( dpeth_t * ) device->specific;	263	dep = ( dpeth_t * ) device->specific;
248	dp8390_cmds[ 0 ].addr = ( void * ) ( uint32_t ) ( dep->de_dp8390_port + DP_ISR );	264	dp8390_cmds[ 0 ].addr = ( void * ) ( uint32_t ) ( dep->de_dp8390_port + DP_ISR );
249	dp8390_cmds[ 2 ].addr = dp8390_cmds[ 0 ].addr;	265	dp8390_cmds[ 2 ].addr = dp8390_cmds[ 0 ].addr;
250	ERROR_PROPAGATE( ipc_register_irq( dep->de_irq, device->device_id, device->device_id, & dp8390_code ));	266	ERROR_PROPAGATE( ipc_register_irq( dep->de_irq, device->device_id, device->device_id, & dp8390_code ));
251	if( ERROR_OCCURRED( do_init( dep, DL_BROAD_REQ ))){	267	if( ERROR_OCCURRED( do_init( dep, DL_BROAD_REQ ))){
252	ipc_unregister_irq( dep->de_irq, device->device_id );	268	ipc_unregister_irq( dep->de_irq, device->device_id );
253	return ERROR_CODE;	269	return ERROR_CODE;
254	}	270	}
255	change_state( device, NETIF_ACTIVE );	271	return change_state( device, NETIF_ACTIVE );
256	}	272	}
257	return EOK;	273	return EOK;
258	}	274	}
259		275
260	int netif_stop_message( device_id_t device_id ){	276	int netif_stop_message( device_ref device ){
261	ERROR_DECLARE;	-
262		-
263	device_ref device;	-
264	dpeth_t * dep;	277	dpeth_t * dep;
265		278
266	ERROR_PROPAGATE( find_device( device_id, & device ));	-
267	if( device->state != NETIF_STOPPED ){	279	if( device->state != NETIF_STOPPED ){
268	dep = ( dpeth_t * ) device->specific;	280	dep = ( dpeth_t * ) device->specific;
269	do_stop( dep );	281	do_stop( dep );
270	ipc_unregister_irq( dep->de_irq, device->device_id );	282	ipc_unregister_irq( dep->de_irq, device->device_id );
271	change_state( device, NETIF_STOPPED );	283	return change_state( device, NETIF_STOPPED );
272	}	284	}
273	return EOK;	285	return EOK;
274	}	286	}
275		287
276	void change_state( device_ref device, device_state_t state ){	288	int change_state( device_ref device, device_state_t state ){
277	device->state = state;	289	device->state = state;
278	nil_message( device, NET_NIL_DEVICE_STATE, device->state, NULL );	-
279	printf( "\nState changed to %s", ( state == NETIF_ACTIVE ) ? "ACTIVE" : "STOPPED" );	290	printf( "\nState changed to %s", ( state == NETIF_ACTIVE ) ? "ACTIVE" : "STOPPED" );
-		291	return state;
280	}	292	}
281		293
282	int netif_initialize( void ){	294	int netif_initialize( void ){
283	ipcarg_t phonehash;	295	ipcarg_t phonehash;
284		296
285	async_set_interrupt_received( irq_handler );	297	async_set_interrupt_received( irq_handler );
286		298
287	return REGISTER_ME( SERVICE_DP8390, & phonehash );	299	return REGISTER_ME( SERVICE_DP8390, & phonehash );
288	}	300	}
289		-
290	int netif_send_packet( dpeth_t * dep, packet_t packet ){	-
291	if( !( dep && dep->parent )) return EINVAL;	-
292	nil_message(( device_ref ) dep->parent, NET_NIL_RECEIVED, packet_get_id( packet ), 0 );	-
293	return EOK;	-
294	}	-
295		301
296	/** @}	302	/** @}
297	*/	303	*/
298		304

Subversion Repositories HelenOS

(root)/branches/network/uspace/srv/net/netif/dp8390/dp8390_module.c – Rev 4243 → 4261