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 <async.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_interface.h"
 
#include "../netif.h"
#include "../netif_module.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 = 1,
        .srcarg = 2
    },
/*  {   .cmd = CMD_PIO_WRITE_8,
        .addr = NULL,
        .value = 0
    },
*/  {
        .cmd = CMD_ACCEPT
    }
};
 
static irq_code_t   dp8390_code = {
    sizeof( dp8390_cmds ) / sizeof( irq_cmd_t ),
    dp8390_cmds
};
 
netif_globals_t netif_globals;
 
void    module_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 module_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 )
{
    device_ref  device;
    dpeth_t *   dep;
    packet_t    received;
    device_id_t device_id;
    int         phone;
 
 
    device_id = IRQ_GET_DEVICE( 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;
    if ( dep->de_mode != DEM_ENABLED){
        rwlock_write_unlock( & netif_globals.lock );
 
        return;
    }
    assert( dep->de_flags & DEF_ENABLED);
    dep->de_int_pending= 0;
    printf( "I%d: %d\n", device_id, IPC_GET_ISR( call ));
 
 
 
 
 
 
 
    dp_check_ints( dep, IPC_GET_ISR( call ));
    if( dep->received_queue ){
        received = dep->received_queue;
        phone = device->nil_phone;
        dep->received_queue = NULL;
        rwlock_write_unlock( & netif_globals.lock );
//  TODO remove debug dump:
    uint8_t *   data;
    data = packet_get_data( received );
    printf( "Receiving 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\n", packet_get_id( received ), packet_get_data_length( received ), 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 ] );
        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;
 
    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;
 
    ERROR_PROPAGATE( find_device( device_id, & device ));
    dep = ( dpeth_t * ) device->specific;
//  TODO remove debug dump:
    uint8_t *   data;
    data = packet_get_data( packet );
    printf( "Sending 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\n", 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 ] );
 
    // 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( "State changed to %s\n", ( 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 4327	Rev 4332
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 <async.h>	37	#include <async.h>
38	#include <ddi.h>	38	#include <ddi.h>
39	#include <errno.h>	39	#include <errno.h>
40	#include <malloc.h>	40	#include <malloc.h>
41	//#include <stdio.h>	41	//#include <stdio.h>
42	#include <ipc/ipc.h>	42	#include <ipc/ipc.h>
43	#include <ipc/services.h>	43	#include <ipc/services.h>
44		44
45	#include "../../err.h"	45	#include "../../err.h"
46	#include "../../messages.h"	46	#include "../../messages.h"
47	#include "../../modules.h"	47	#include "../../modules.h"
48		48
49	#include "../../structures/packet/packet_client.h"	49	#include "../../structures/packet/packet_client.h"
50	#include "../../structures/measured_strings.h"	50	#include "../../structures/measured_strings.h"
51		51
52	#include "../../include/device.h"	52	#include "../../include/device.h"
53	#include "../../include/nil_interface.h"	53	#include "../../include/nil_interface.h"
54		54
55	#include "../netif.h"	55	#include "../netif.h"
56	#include "../netif_module.h"	56	#include "../netif_module.h"
57		57
58	#include "dp8390.h"	58	#include "dp8390.h"
59	#include "dp8390_drv.h"	59	#include "dp8390_drv.h"
60	#include "dp8390_port.h"	60	#include "dp8390_port.h"
61		61
62	#define NAME "dp8390 network interface"	62	#define NAME "dp8390 network interface"
63		63
64	#define IRQ_GET_DEVICE( call ) ( device_id_t ) IPC_GET_METHOD( * call )	64	#define IRQ_GET_DEVICE( call ) ( device_id_t ) IPC_GET_METHOD( * call )
65	#define IPC_GET_ISR( call ) ( int ) IPC_GET_ARG2( * call )	65	#define IPC_GET_ISR( call ) ( int ) IPC_GET_ARG2( * call )
66		66
67	static irq_cmd_t dp8390_cmds[] = {	67	static irq_cmd_t dp8390_cmds[] = {
68	{ .cmd = CMD_PIO_READ_8,	68	{ .cmd = CMD_PIO_READ_8,
69	.addr = NULL,	69	.addr = NULL,
70	.dstarg = 2	70	.dstarg = 2
71	},	71	},
72	{	72	{
73	.cmd = CMD_PREDICATE,	73	.cmd = CMD_PREDICATE,
74	.value = 1,	74	.value = 1,
75	.srcarg = 2	75	.srcarg = 2
76	},	76	},
77	/* { .cmd = CMD_PIO_WRITE_8,	77	/* { .cmd = CMD_PIO_WRITE_8,
78	.addr = NULL,	78	.addr = NULL,
79	.value = 0	79	.value = 0
80	},	80	},
81	*/ {	81	*/ {
82	.cmd = CMD_ACCEPT	82	.cmd = CMD_ACCEPT
83	}	83	}
84	};	84	};
85		85
86	static irq_code_t dp8390_code = {	86	static irq_code_t dp8390_code = {
87	sizeof( dp8390_cmds ) / sizeof( irq_cmd_t ),	87	sizeof( dp8390_cmds ) / sizeof( irq_cmd_t ),
88	dp8390_cmds	88	dp8390_cmds
89	};	89	};
90		90
91	netif_globals_t netif_globals;	91	netif_globals_t netif_globals;
92		92
93	void module_print_name( void );	93	void module_print_name( void );
94		94
95	void irq_handler( ipc_callid_t iid, ipc_call_t * call );	95	void irq_handler( ipc_callid_t iid, ipc_call_t * call );
96	int change_state( device_ref device, device_state_t state );	96	int change_state( device_ref device, device_state_t state );
97		97
98	int netif_specific_message( ipc_callid_t callid, ipc_call_t * call, ipc_call_t * answer, int * answer_count ){	98	int netif_specific_message( ipc_callid_t callid, ipc_call_t * call, ipc_call_t * answer, int * answer_count ){
99	return ENOTSUP;	99	return ENOTSUP;
100	}	100	}
101		101
102	int netif_get_device_stats( device_id_t device_id, device_stats_ref stats ){	102	int netif_get_device_stats( device_id_t device_id, device_stats_ref stats ){
103	ERROR_DECLARE;	103	ERROR_DECLARE;
104		104
105	device_ref device;	105	device_ref device;
106	eth_stat_t * de_stat;	106	eth_stat_t * de_stat;
107		107
108	if( ! stats ) return EBADMEM;	108	if( ! stats ) return EBADMEM;
109	ERROR_PROPAGATE( find_device( device_id, & device ));	109	ERROR_PROPAGATE( find_device( device_id, & device ));
110	de_stat = & (( dpeth_t * ) device->specific )->de_stat;	110	de_stat = & (( dpeth_t * ) device->specific )->de_stat;
111	null_device_stats( stats );	111	null_device_stats( stats );
112	stats->rx_errors = de_stat->ets_recvErr;	112	stats->rx_errors = de_stat->ets_recvErr;
113	stats->tx_errors = de_stat->ets_sendErr;	113	stats->tx_errors = de_stat->ets_sendErr;
114	stats->rx_crc_errors = de_stat->ets_CRCerr;	114	stats->rx_crc_errors = de_stat->ets_CRCerr;
115	stats->rx_frame_errors = de_stat->ets_frameAll;	115	stats->rx_frame_errors = de_stat->ets_frameAll;
116	stats->rx_missed_errors = de_stat->ets_missedP;	116	stats->rx_missed_errors = de_stat->ets_missedP;
117	stats->rx_packets = de_stat->ets_packetR;	117	stats->rx_packets = de_stat->ets_packetR;
118	stats->tx_packets = de_stat->ets_packetT;	118	stats->tx_packets = de_stat->ets_packetT;
119	stats->collisions = de_stat->ets_collision;	119	stats->collisions = de_stat->ets_collision;
120	stats->tx_aborted_errors = de_stat->ets_transAb;	120	stats->tx_aborted_errors = de_stat->ets_transAb;
121	stats->tx_carrier_errors = de_stat->ets_carrSense;	121	stats->tx_carrier_errors = de_stat->ets_carrSense;
122	stats->tx_heartbeat_errors = de_stat->ets_CDheartbeat;	122	stats->tx_heartbeat_errors = de_stat->ets_CDheartbeat;
123	stats->tx_window_errors = de_stat->ets_OWC;	123	stats->tx_window_errors = de_stat->ets_OWC;
124	return EOK;	124	return EOK;
125	}	125	}
126		126
127	void module_print_name( void ){	127	void module_print_name( void ){
128	printf( "%s", NAME );	128	printf( "%s", NAME );
129	}	129	}
130		130
131	int netif_get_addr_message( device_id_t device_id, measured_string_ref address ){	131	int netif_get_addr_message( device_id_t device_id, measured_string_ref address ){
132	ERROR_DECLARE;	132	ERROR_DECLARE;
133		133
134	device_ref device;	134	device_ref device;
135		135
136	if( ! address ) return EBADMEM;	136	if( ! address ) return EBADMEM;
137	ERROR_PROPAGATE( find_device( device_id, & device ));	137	ERROR_PROPAGATE( find_device( device_id, & device ));
138	address->value = ( char * ) ( & (( dpeth_t * ) device->specific )->de_address );	138	address->value = ( char * ) ( & (( dpeth_t * ) device->specific )->de_address );
139	address->length = CONVERT_SIZE( ether_addr_t, char, 1 );	139	address->length = CONVERT_SIZE( ether_addr_t, char, 1 );
140	return EOK;	140	return EOK;
141	}	141	}
142		142
143	void irq_handler( ipc_callid_t iid, ipc_call_t * call )	143	void irq_handler( ipc_callid_t iid, ipc_call_t * call )
144	{	144	{
145	device_ref device;	145	device_ref device;
146	dpeth_t * dep;	146	dpeth_t * dep;
147	packet_t received;	147	packet_t received;
148	device_id_t device_id;	148	device_id_t device_id;
149	int phone;	149	int phone;
150		150
151	// async_serialize_start();	-
152	device_id = IRQ_GET_DEVICE( call );	151	device_id = IRQ_GET_DEVICE( call );
153	rwlock_write_lock( & netif_globals.lock );	152	rwlock_write_lock( & netif_globals.lock );
154	if( find_device( device_id, & device ) != EOK ){	153	if( find_device( device_id, & device ) != EOK ){
155	rwlock_write_unlock( & netif_globals.lock );	154	rwlock_write_unlock( & netif_globals.lock );
156	// async_serialize_end()	-
157	return;	155	return;
158	}	156	}
159	dep = ( dpeth_t * ) device->specific;	157	dep = ( dpeth_t * ) device->specific;
160	if ( dep->de_mode != DEM_ENABLED){	158	if ( dep->de_mode != DEM_ENABLED){
161	rwlock_write_unlock( & netif_globals.lock );	159	rwlock_write_unlock( & netif_globals.lock );
162	// async_serialize_end()	-
163	return;	160	return;
164	}	161	}
165	assert( dep->de_flags & DEF_ENABLED);	162	assert( dep->de_flags & DEF_ENABLED);
166	dep->de_int_pending= 0;	163	dep->de_int_pending= 0;
167	printf( "I%d -%d\n", device_id, IPC_GET_ISR( call ));	164	printf( "I%d: %d\n", device_id, IPC_GET_ISR( call ));
168	/* putchar( 'I' );	-
169	putchar( '0' + device_id );	-
170	putchar( '-' );	-
171	putchar( '0' + IPC_GET_ISR( call ) / 100 );	-
172	putchar( '0' + ( IPC_GET_ISR( call ) % 100 ) / 10 );	-
173	putchar( '0' + IPC_GET_ISR( call ) % 10 );	-
174	putchar( '\n' );	-
175	*/ dp_check_ints( dep, IPC_GET_ISR( call ));	165	dp_check_ints( dep, IPC_GET_ISR( call ));
176	if( dep->received_queue ){	166	if( dep->received_queue ){
177	received = dep->received_queue;	167	received = dep->received_queue;
178	phone = device->nil_phone;	168	phone = device->nil_phone;
179	dep->received_queue = NULL;	169	dep->received_queue = NULL;
180	rwlock_write_unlock( & netif_globals.lock );	170	rwlock_write_unlock( & netif_globals.lock );
-		171	// TODO remove debug dump:
-		172	uint8_t * data;
-		173	data = packet_get_data( received );
-		174	printf( "Receiving 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\n", packet_get_id( received ), packet_get_data_length( received ), 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 ] );
181	nil_received_msg( phone, device_id, received, NULL );	175	nil_received_msg( phone, device_id, received, NULL );
182	}else{	176	}else{
183	rwlock_write_unlock( & netif_globals.lock );	177	rwlock_write_unlock( & netif_globals.lock );
184	}	178	}
185	ipc_answer_0( iid, EOK );	179	ipc_answer_0( iid, EOK );
186	// async_serialize_end()	-
187	}	180	}
188		181
189	int netif_probe_auto_message( void ){	182	int netif_probe_auto_message( void ){
190	return ENOTSUP;	183	return ENOTSUP;
191	}	184	}
192		185
193	int netif_probe_message( device_id_t device_id, int irq, int io ){	186	int netif_probe_message( device_id_t device_id, int irq, int io ){
194	ERROR_DECLARE;	187	ERROR_DECLARE;
195		188
196	device_ref device;	189	device_ref device;
197	dpeth_t * dep;	190	dpeth_t * dep;
198		191
199	device = ( device_ref ) malloc( sizeof( device_t ));	192	device = ( device_ref ) malloc( sizeof( device_t ));
200	if( ! device ) return ENOMEM;	193	if( ! device ) return ENOMEM;
201	dep = ( dpeth_t * ) malloc( sizeof( dpeth_t ));	194	dep = ( dpeth_t * ) malloc( sizeof( dpeth_t ));
202	if( ! dep ){	195	if( ! dep ){
203	free( device );	196	free( device );
204	return ENOMEM;	197	return ENOMEM;
205	}	198	}
206	bzero( device, sizeof( device_t ));	199	bzero( device, sizeof( device_t ));
207	bzero( dep, sizeof( dpeth_t ));	200	bzero( dep, sizeof( dpeth_t ));
208	device->device_id = device_id;	201	device->device_id = device_id;
209	device->nil_phone = -1;	202	device->nil_phone = -1;
210	device->specific = ( void * ) dep;	203	device->specific = ( void * ) dep;
211	device->state = NETIF_STOPPED;	204	device->state = NETIF_STOPPED;
212	dep->de_irq = irq;	205	dep->de_irq = irq;
213	dep->de_mode = DEM_DISABLED;	206	dep->de_mode = DEM_DISABLED;
214	//TODO address?	207	//TODO address?
215	if( ERROR_OCCURRED( pio_enable(( void * ) io, DP8390_IO_SIZE, ( void ** ) & dep->de_base_port ))	208	if( ERROR_OCCURRED( pio_enable(( void * ) io, DP8390_IO_SIZE, ( void ** ) & dep->de_base_port ))
216	\|\| ERROR_OCCURRED( do_probe( dep ))){	209	\|\| ERROR_OCCURRED( do_probe( dep ))){
217	free( dep );	210	free( dep );
218	free( device );	211	free( device );
219	return ERROR_CODE;	212	return ERROR_CODE;
220	}	213	}
221	if( ERROR_OCCURRED( device_map_add( & netif_globals.device_map, device->device_id, device ))){	214	if( ERROR_OCCURRED( device_map_add( & netif_globals.device_map, device->device_id, device ))){
222	free( dep );	215	free( dep );
223	free( device );	216	free( device );
224	return ERROR_CODE;	217	return ERROR_CODE;
225	}	218	}
226	return EOK;	219	return EOK;
227	}	220	}
228		221
229	int netif_send_message( device_id_t device_id, packet_t packet, services_t sender ){	222	int netif_send_message( device_id_t device_id, packet_t packet, services_t sender ){
230	ERROR_DECLARE;	223	ERROR_DECLARE;
231		224
232	device_ref device;	225	device_ref device;
233	dpeth_t * dep;	226	dpeth_t * dep;
234	packet_t next;	227	packet_t next;
235		228
236	ERROR_PROPAGATE( find_device( device_id, & device ));	229	ERROR_PROPAGATE( find_device( device_id, & device ));
237	dep = ( dpeth_t * ) device->specific;	230	dep = ( dpeth_t * ) device->specific;
238	// TODO remove debug dump:	231	// TODO remove debug dump:
239	uint8_t * data;	232	uint8_t * data;
240	data = packet_get_data( packet );	233	data = packet_get_data( packet );
241	printf( "Sending 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\n", 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 ] );	234	printf( "Sending 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\n", 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		235
243	// process packet queue	236	// process packet queue
244	do{	237	do{
245	next = pq_detach( packet );	238	next = pq_detach( packet );
246	if( do_pwrite( dep, packet, FALSE ) != EBUSY ){	239	if( do_pwrite( dep, packet, FALSE ) != EBUSY ){
247	netif_pq_release( packet_get_id( packet ));	240	netif_pq_release( packet_get_id( packet ));
248	}	241	}
249	packet = next;	242	packet = next;
250	}while( packet );	243	}while( packet );
251	dp8390_dump( dep );	-
252	return EOK;	244	return EOK;
253	}	245	}
254		246
255	int netif_start_message( device_ref device ){	247	int netif_start_message( device_ref device ){
256	ERROR_DECLARE;	248	ERROR_DECLARE;
257		249
258	dpeth_t * dep;	250	dpeth_t * dep;
259		251
260	if( device->state != NETIF_ACTIVE ){	252	if( device->state != NETIF_ACTIVE ){
261	dep = ( dpeth_t * ) device->specific;	253	dep = ( dpeth_t * ) device->specific;
262	dp8390_cmds[ 0 ].addr = ( void * ) ( uint32_t ) ( dep->de_dp8390_port + DP_ISR );	254	dp8390_cmds[ 0 ].addr = ( void * ) ( uint32_t ) ( dep->de_dp8390_port + DP_ISR );
263	dp8390_cmds[ 2 ].addr = dp8390_cmds[ 0 ].addr;	255	dp8390_cmds[ 2 ].addr = dp8390_cmds[ 0 ].addr;
264	ERROR_PROPAGATE( ipc_register_irq( dep->de_irq, device->device_id, device->device_id, & dp8390_code ));	256	ERROR_PROPAGATE( ipc_register_irq( dep->de_irq, device->device_id, device->device_id, & dp8390_code ));
265	if( ERROR_OCCURRED( do_init( dep, DL_BROAD_REQ ))){	257	if( ERROR_OCCURRED( do_init( dep, DL_BROAD_REQ ))){
266	ipc_unregister_irq( dep->de_irq, device->device_id );	258	ipc_unregister_irq( dep->de_irq, device->device_id );
267	return ERROR_CODE;	259	return ERROR_CODE;
268	}	260	}
269	return change_state( device, NETIF_ACTIVE );	261	return change_state( device, NETIF_ACTIVE );
270	}	262	}
271	return EOK;	263	return EOK;
272	}	264	}
273		265
274	int netif_stop_message( device_ref device ){	266	int netif_stop_message( device_ref device ){
275	dpeth_t * dep;	267	dpeth_t * dep;
276		268
277	if( device->state != NETIF_STOPPED ){	269	if( device->state != NETIF_STOPPED ){
278	dep = ( dpeth_t * ) device->specific;	270	dep = ( dpeth_t * ) device->specific;
279	do_stop( dep );	271	do_stop( dep );
280	ipc_unregister_irq( dep->de_irq, device->device_id );	272	ipc_unregister_irq( dep->de_irq, device->device_id );
281	return change_state( device, NETIF_STOPPED );	273	return change_state( device, NETIF_STOPPED );
282	}	274	}
283	return EOK;	275	return EOK;
284	}	276	}
285		277
286	int change_state( device_ref device, device_state_t state ){	278	int change_state( device_ref device, device_state_t state ){
287	device->state = state;	279	device->state = state;
288	printf( "State changed to %s\n", ( state == NETIF_ACTIVE ) ? "ACTIVE" : "STOPPED" );	280	printf( "State changed to %s\n", ( state == NETIF_ACTIVE ) ? "ACTIVE" : "STOPPED" );
289	return state;	281	return state;
290	}	282	}
291		283
292	int netif_initialize( void ){	284	int netif_initialize( void ){
293	ipcarg_t phonehash;	285	ipcarg_t phonehash;
294		286
295	async_set_interrupt_received( irq_handler );	287	async_set_interrupt_received( irq_handler );
296		288
297	return REGISTER_ME( SERVICE_DP8390, & phonehash );	289	return REGISTER_ME( SERVICE_DP8390, & phonehash );
298	}	290	}
299		291
300	/** @}	292	/** @}
301	*/	293	*/
302		294

Subversion Repositories HelenOS

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