Kernel/x86 - (minor) Fix spaces in log output on ZERO page

[tpg/acess2.git] / UDI / drivers / net_ne2000 / ne2000_core.c

diff --git a/UDI/drivers/net_ne2000/ne2000_core.c b/UDI/drivers/net_ne2000/ne2000_core.c
index 0161247..d630a8d 100644 (file)
--- a/UDI/drivers/net_ne2000/ne2000_core.c
+++ b/UDI/drivers/net_ne2000/ne2000_core.c
@@ -5,8 +5,6 @@
  * ne2000_core.c
  * - UDI initialisation 
  */
-#include <udi.h>
-#include <udi_nic.h>
 #include "ne2000_common.h"
 
 enum {
@@ -29,10 +27,6 @@ enum {
 #define NE2K_NUM_INTR_EVENT_CBS        4
 
 // === GLOBALS ===
-#define PIO_op_RI(op, reg, sz, val)    {UDI_PIO_##op+UDI_PIO_DIRECT+UDI_PIO_##reg, UDI_PIO_##sz##BYTE, val}
-#define PIO_MOV_RI1(reg, val)  PIO_op_RI(LOAD_IMM, reg, 1, val)
-#define PIO_OUT_RI1(reg, ofs)  PIO_op_RI(OUT, reg, 1, ofs)
-#define PIO_IN_RI1(reg, ofs)   PIO_op_RI(IN, reg, 1, ofs)
 // --- Programmed IO ---
 #include "ne2000_pio.h"
 
@@ -40,6 +34,10 @@ enum {
 // --- Management
 void ne2k_usage_ind(udi_usage_cb_t *cb, udi_ubit8_t resource_level)
 {
+       ne2k_rdata_t    *rdata = UDI_GCB(cb)->context;
+
+       rdata->rx_next_page = NE2K_RX_FIRST_PG;
+       
        udi_usage_res(cb);
 }
 void ne2k_enumerate_req(udi_enumerate_cb_t *cb, udi_ubit8_t enumeration_level)
@@ -56,7 +54,7 @@ void ne2k_enumerate_req(udi_enumerate_cb_t *cb, udi_ubit8_t enumeration_level)
                attr_list ++;
                DPT_SET_ATTR_STRING(attr_list, "if_media", "eth", 3);
                attr_list ++;
-               NE2K_SET_ATTR_STRFMT(attr_list, "identifier", 2*6+1, "%2X%2X%2X%2X%2X%2X",
+               NE2K_SET_ATTR_STRFMT(attr_list, "identifier", 2*6+1, "%02X%02X%02X%02X%02X%02X",
                        rdata->macaddr[0], rdata->macaddr[1], rdata->macaddr[2],
                        rdata->macaddr[3], rdata->macaddr[4], rdata->macaddr[5] );
                attr_list ++;
@@ -66,6 +64,9 @@ void ne2k_enumerate_req(udi_enumerate_cb_t *cb, udi_ubit8_t enumeration_level)
        case UDI_ENUMERATE_NEXT:
                udi_enumerate_ack(cb, UDI_ENUMERATE_DONE, 0);
                break;
+       default:
+               udi_assert(!"invalid enumeration_level");
+               break;
        }
 }
 void ne2k_devmgmt_req(udi_mgmt_cb_t *cb, udi_ubit8_t mgmt_op, udi_ubit8_t parent_ID)
@@ -77,15 +78,22 @@ void ne2k_final_cleanup_req(udi_mgmt_cb_t *cb)
 // --- Bus
 void ne2k_bus_dev_channel_event_ind(udi_channel_event_cb_t *cb)
 {
+       udi_cb_t        *gcb = UDI_GCB(cb);
+       ne2k_rdata_t    *rdata = gcb->context;
+       
        switch(cb->event)
        {
        case UDI_CHANNEL_CLOSED:
                break;
        case UDI_CHANNEL_BOUND: {
+               rdata->active_cb = gcb;
                udi_bus_bind_cb_t *bus_bind_cb = UDI_MCB(cb->params.parent_bound.bind_cb, udi_bus_bind_cb_t);
                udi_bus_bind_req( bus_bind_cb );
                // continue at ne2k_bus_dev_bus_bind_ack
                return; }
+       default:
+               udi_assert(!"invalid channel event");
+               break;
        }
 }
 void ne2k_bus_dev_bus_bind_ack(udi_bus_bind_cb_t *cb,
@@ -93,7 +101,6 @@ void ne2k_bus_dev_bus_bind_ack(udi_bus_bind_cb_t *cb,
 {
        udi_cb_t        *gcb = UDI_GCB(cb);
        ne2k_rdata_t    *rdata = gcb->context;
-       rdata->active_cb = gcb;
        
        // Set up PIO handles
        rdata->init.pio_index = -1;
@@ -103,9 +110,10 @@ void ne2k_bus_dev_bind__pio_map(udi_cb_t *gcb, udi_pio_handle_t new_pio_handle)
 {
        ne2k_rdata_t    *rdata = gcb->context;
        
-       if( rdata->init.pio_index != -1 )
+       if( rdata->init.pio_index != (udi_index_t)-1 )
        {
                rdata->pio_handles[rdata->init.pio_index] = new_pio_handle;
+               udi_debug_printf("PIO %i = %p\n", rdata->init.pio_index, new_pio_handle);
        }
        rdata->init.pio_index ++;
        if( rdata->init.pio_index < NE2K_NUM_PIO_OPS )
@@ -222,11 +230,22 @@ void ne2k_nd_ctrl_bind__tx_chan_ok(udi_cb_t *gcb, udi_channel_t new_channel)
                rdata->init.rx_chan_index, NE2K_OPS_RX, rdata);
        // V V V V
 }
-void ne2k_nd_ctrl_bind__rx_chan_ok(udi_cb_t *cb, udi_channel_t new_channel)
+void ne2k_nd_ctrl_bind__rx_chan_ok(udi_cb_t *gcb, udi_channel_t new_channel)
 {
-       ne2k_rdata_t    *rdata = cb->context;
+       ne2k_rdata_t    *rdata = gcb->context;
        rdata->rx_channel = new_channel;
-       udi_nsr_bind_ack( UDI_MCB(cb, udi_nic_bind_cb_t), UDI_OK );
+       
+       udi_nic_bind_cb_t *cb = UDI_MCB(gcb, udi_nic_bind_cb_t);
+       cb->media_type = UDI_NIC_ETHER;
+       cb->min_pdu_size = 0;
+       cb->max_pdu_size = 0;
+       cb->rx_hw_threshold = 2;
+       cb->capabilities = 0;
+       cb->max_perfect_multicast = 0;
+       cb->max_total_multicast = 0;
+       cb->mac_addr_len = 6;
+       udi_memcpy(cb->mac_addr, rdata->macaddr, 6);
+       udi_nsr_bind_ack( cb, UDI_OK );
        // = = = =
 }
 void ne2k_nd_ctrl_unbind_req(udi_nic_cb_t *cb)
@@ -234,7 +253,14 @@ void ne2k_nd_ctrl_unbind_req(udi_nic_cb_t *cb)
 }
 void ne2k_nd_ctrl_enable_req(udi_nic_cb_t *cb)
 {
-       // Enable
+       udi_cb_t        *gcb = UDI_GCB(cb);
+       ne2k_rdata_t    *rdata = gcb->context;
+       udi_pio_trans(ne2k_nd_ctrl_enable_req__trans_done, gcb,
+               rdata->pio_handles[NE2K_PIO_ENABLE], 0, NULL, NULL);
+}
+void ne2k_nd_ctrl_enable_req__trans_done(udi_cb_t *gcb, udi_buf_t *new_buf, udi_status_t status, udi_ubit16_t res)
+{
+       udi_nsr_enable_ack( UDI_MCB(gcb, udi_nic_cb_t), status );
 }
 void ne2k_nd_ctrl_disable_req(udi_nic_cb_t *cb)
 {
@@ -251,10 +277,16 @@ void ne2k_bus_irq_channel_event_ind(udi_channel_event_cb_t *cb)
 }
 void ne2k_bus_irq_intr_event_ind(udi_intr_event_cb_t *cb, udi_ubit8_t flags)
 {
+       udi_debug_printf("ne2k_bus_irq_intr_event_ind: flags=%x, intr_result=%x\n",
+               flags, cb->intr_result);
        if( cb->intr_result & 0x01 )
        {
                ne2k_intr__rx_ok( UDI_GCB(cb) );
        }
+       if( cb->intr_result & 0x40 )
+       {
+               // ne2k_intr__rdma( UDI_GCB(cb) );
+       }
        // TODO: TX IRQs
        udi_intr_event_rdy(cb);
 }