linux-imx

/*

 * Allocate service buffer and tell card about it

 */

static int service_buffer_allocate(struct lanai_dev *lanai)

{

    lanai_buf_allocate(&lanai->service, SERVICE_ENTRIES * 4, 8,

        lanai->pci);

    if (unlikely(lanai->service.start == NULL))

        return -ENOMEM;

        lanai_buf_size(&lanai->service),

        lanai_buf_size_cardorder(&lanai->service));

    /* Clear ServWrite register to be safe */

    reg_write(lanai, 0, ServWrite_Reg);

    /* ServiceStuff register contains size and address of buffer */

    reg_write(lanai,

        SSTUFF_SET_SIZE(lanai_buf_size_cardorder(&lanai->service)) |

        SSTUFF_SET_ADDR(lanai->service.dmaaddr),

        ServiceStuff_Reg);

    return 0;

    conf1_write(lanai);

    lanai->status = reg_read(lanai, Status_Reg);

    /* We're now done initializing this card */

#ifdef USE_POWERDOWN

    lanai->conf1 |= CONFIG1_POWERDOWN;

    conf1_write(lanai);

#endif

    memcpy(atmdev->esi, eeprom_mac(lanai), ESI_LEN);

    lanai_timed_poll_start(lanai);

        "(%pMF)\n", lanai->number, (int) lanai->pci->revision,

    printk(KERN_NOTICE DEV_LABEL "(itf %d): LANAI%s, serialno=%u(0x%X), "

        "board_rev=%d\n", lanai->number,

        lanai->type==lanai2 ? "2" : "HB", (unsigned int) lanai->serialno,

        (unsigned int) lanai->serialno, lanai->board_rev);

    return 0;

​

    error_vcctable:

    vcc_table_deallocate(lanai);

    error_service:

    service_buffer_deallocate(lanai);