/** * Dispatches an AFC packet over a client. * * @param client The client to send data through. * @param operation The operation to perform. * @param data The data to send together with the header. * @param data_length The length of the data to send with the header. * @param payload The data to send after the header has been sent. * @param payload_length The length of data to send after the header. * @param bytes_sent The total number of bytes actually sent. * * @return AFC_E_SUCCESS on success or an AFC_E_* error value. */ static afc_error_t afc_dispatch_packet(afc_client_t client, uint64_t operation, const char *data, uint32_t data_length, const char* payload, uint32_t payload_length, uint32_t *bytes_sent) { uint32_t sent = 0; if (!client || !client->parent || !client->afc_packet) return AFC_E_INVALID_ARG; *bytes_sent = 0; if (!data || !data_length) data_length = 0; if (!payload || !payload_length) payload_length = 0; client->afc_packet->packet_num++; client->afc_packet->operation = operation; client->afc_packet->entire_length = sizeof(AFCPacket) + data_length + payload_length; client->afc_packet->this_length = sizeof(AFCPacket) + data_length; debug_info("packet length = %i", client->afc_packet->this_length); debug_buffer((char*)client->afc_packet, sizeof(AFCPacket)); /* send AFC packet header */ AFCPacket_to_LE(client->afc_packet); sent = 0; service_send(client->parent, (void*)client->afc_packet, sizeof(AFCPacket), &sent); AFCPacket_from_LE(client->afc_packet); *bytes_sent += sent; if (sent < sizeof(AFCPacket)) { return AFC_E_SUCCESS; } /* send AFC packet data (if there's data to send) */ sent = 0; if (data_length > 0) { debug_info("packet data follows"); debug_buffer(data, data_length); service_send(client->parent, data, data_length, &sent); } *bytes_sent += sent; if (sent < data_length) { return AFC_E_SUCCESS; } sent = 0; if (payload_length > 0) { debug_info("packet payload follows"); debug_buffer(payload, payload_length); service_send(client->parent, payload, payload_length, &sent); } *bytes_sent += sent; if (sent < payload_length) { return AFC_E_SUCCESS; } return AFC_E_SUCCESS; }
/** * Dispatches an AFC packet over a client. * * @param client The client to send data through. * @param data The data to send. * @param length The length to send. * @param bytes_sent The number of bytes actually sent. * * @return AFC_E_SUCCESS on success or an AFC_E_* error value. * * @warning set client->afc_packet->this_length and * client->afc_packet->entire_length to 0 before calling this. The * reason is that if you set them to different values, it indicates * you want to send the data as two packets. */ static afc_error_t afc_dispatch_packet(afc_client_t client, const char *data, uint32_t length, uint32_t *bytes_sent) { uint32_t offset = 0; uint32_t sent = 0; if (!client || !client->parent || !client->afc_packet) return AFC_E_INVALID_ARG; *bytes_sent = 0; if (!data || !length) length = 0; client->afc_packet->packet_num++; if (!client->afc_packet->entire_length) { client->afc_packet->entire_length = (length) ? sizeof(AFCPacket) + length : sizeof(AFCPacket); client->afc_packet->this_length = client->afc_packet->entire_length; } if (!client->afc_packet->this_length) { client->afc_packet->this_length = sizeof(AFCPacket); } /* We want to send two segments; buffer+sizeof(AFCPacket) to this_length is the parameters and everything beyond that is the next packet. (for writing) */ if (client->afc_packet->this_length != client->afc_packet->entire_length) { offset = (uint32_t)(client->afc_packet->this_length - sizeof(AFCPacket)); debug_info("Offset: %i", offset); if ((length) < (client->afc_packet->entire_length - client->afc_packet->this_length)) { debug_info("Length did not resemble what it was supposed to based on packet"); debug_info("length minus offset: %i", length - offset); debug_info("rest of packet: %i\n", client->afc_packet->entire_length - client->afc_packet->this_length); return AFC_E_INTERNAL_ERROR; } /* send AFC packet header */ AFCPacket_to_LE(client->afc_packet); sent = 0; service_send(client->parent, (const char *)client->afc_packet, sizeof(AFCPacket), &sent); AFCPacket_from_LE(client->afc_packet); if (sent == 0) { /* FIXME: should this be handled as success?! */ return AFC_E_SUCCESS; } *bytes_sent += sent; /* send AFC packet data */ sent = 0; service_send(client->parent, data, offset, &sent); if (sent == 0) { return AFC_E_SUCCESS; } *bytes_sent += sent; debug_info("sent the first now go with the second"); debug_info("Length: %i", length - offset); debug_info("Buffer: "); debug_buffer(data + offset, length - offset); sent = 0; service_send(client->parent, data + offset, length - offset, &sent); *bytes_sent = sent; return AFC_E_SUCCESS; } else { debug_info("doin things the old way"); debug_info("packet length = %i", client->afc_packet->this_length); debug_buffer((char*)client->afc_packet, sizeof(AFCPacket)); /* send AFC packet header */ AFCPacket_to_LE(client->afc_packet); sent = 0; service_send(client->parent, (const char *)client->afc_packet, sizeof(AFCPacket), &sent); AFCPacket_from_LE(client->afc_packet); if (sent == 0) { return AFC_E_SUCCESS; } *bytes_sent += sent; /* send AFC packet data (if there's data to send) */ if (length > 0) { debug_info("packet data follows"); debug_buffer(data, length); service_send(client->parent, data, length, &sent); *bytes_sent += sent; } return AFC_E_SUCCESS; } return AFC_E_INTERNAL_ERROR; }