/**
* 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;
}
