72     }

    72     }

    73 

    73 

    74     ret = ec_datagram_fpwr(datagram, slave->station_address,

    74     ret = ec_datagram_fpwr(datagram, slave->station_address,

    75             slave->configured_rx_mailbox_offset,

    75             slave->configured_rx_mailbox_offset,

    76             slave->configured_rx_mailbox_size);

    76             slave->configured_rx_mailbox_size);

    78         return ERR_PTR(ret);

    78         return ERR_PTR(ret);

    79 

    80 

    80     EC_WRITE_U16(datagram->data,     size); // mailbox service data length

    81     EC_WRITE_U16(datagram->data,     size); // mailbox service data length

    81     EC_WRITE_U16(datagram->data + 2, slave->station_address); // station addr.

    82     EC_WRITE_U16(datagram->data + 2, slave->station_address); // station addr.

    82     EC_WRITE_U8 (datagram->data + 4, 0x00); // channel & priority

    83     EC_WRITE_U8 (datagram->data + 4, 0x00); // channel & priority

    83     EC_WRITE_U8 (datagram->data + 5, type); // underlying protocol type

    84     EC_WRITE_U8 (datagram->data + 5, type); // underlying protocol type