Ignore:
File:
1 edited

Legend:

Unmodified
Added
Removed

  • uspace/lib/socket/packet/packet_client.c

    r29fa68b rcaad59a  
    4646#include <packet/packet_client.h>
    4747
    48 int packet_copy_data(packet_t packet, const void * data, size_t length)
    49 {
    50         if (!packet_is_valid(packet))
     48int packet_copy_data(packet_t packet, const void * data, size_t length){
     49        if(! packet_is_valid(packet)){
    5150                return EINVAL;
    52 
    53         if (packet->data_start + length >= packet->length)
     51        }
     52        if(packet->data_start + length >= packet->length){
    5453                return ENOMEM;
    55 
     54        }
    5655        memcpy((void *) packet + packet->data_start, data, length);
    57         if (packet->data_start + length > packet->data_end)
     56        if(packet->data_start + length > packet->data_end){
    5857                packet->data_end = packet->data_start + length;
    59 
     58        }
    6059        return EOK;
    6160}
    6261
    63 void *packet_prefix(packet_t packet, size_t length)
    64 {
    65         if ((!packet_is_valid(packet)) ||
    66             (packet->data_start - sizeof(struct packet) -
    67             2 * (packet->dest_addr - packet->src_addr) < length)) {
     62void * packet_prefix(packet_t packet, size_t length){
     63        if((! packet_is_valid(packet)) || (packet->data_start - sizeof(struct packet) - 2 * (packet->dest_addr - packet->src_addr) < length)){
    6864                return NULL;
    6965        }
    70 
    7166        packet->data_start -= length;
    7267        return (void *) packet + packet->data_start;
    7368}
    7469
    75 void *packet_suffix(packet_t packet, size_t length)
    76 {
    77         if ((!packet_is_valid(packet)) ||
    78             (packet->data_end + length >= packet->length)) {
     70void * packet_suffix(packet_t packet, size_t length){
     71        if((! packet_is_valid(packet)) || (packet->data_end + length >= packet->length)){
    7972                return NULL;
    8073        }
    81 
    8274        packet->data_end += length;
    8375        return (void *) packet + packet->data_end - length;
    8476}
    8577
    86 int packet_trim(packet_t packet, size_t prefix, size_t suffix)
    87 {
    88         if (!packet_is_valid(packet))
     78int packet_trim(packet_t packet, size_t prefix, size_t suffix){
     79        if(! packet_is_valid(packet)){
    8980                return EINVAL;
    90 
    91         if (prefix + suffix > PACKET_DATA_LENGTH(packet))
     81        }
     82        if(prefix + suffix > PACKET_DATA_LENGTH(packet)){
    9283                return ENOMEM;
    93 
     84        }
    9485        packet->data_start += prefix;
    9586        packet->data_end -= suffix;
    … …  
    9788}
    9889
    99 packet_id_t packet_get_id(const packet_t packet)
    100 {
     90packet_id_t packet_get_id(const packet_t packet){
    10191        return packet_is_valid(packet) ? packet->packet_id : 0;
    10292}
    10393
    104 int packet_get_addr(const packet_t packet, uint8_t ** src, uint8_t ** dest)
    105 {
    106         if (!packet_is_valid(packet))
     94int packet_get_addr(const packet_t packet, uint8_t ** src, uint8_t ** dest){
     95        if(! packet_is_valid(packet)){
    10796                return EINVAL;
    108         if (!packet->addr_len)
     97        }
     98        if(! packet->addr_len){
    10999                return 0;
    110         if (src)
     100        }
     101        if(src){
    111102                *src = (void *) packet + packet->src_addr;
    112         if (dest)
     103        }
     104        if(dest){
    113105                *dest = (void *) packet + packet->dest_addr;
    114 
     106        }
    115107        return packet->addr_len;
    116108}
    117109
    118 size_t packet_get_data_length(const packet_t packet)
    119 {
    120         if (!packet_is_valid(packet))
     110size_t packet_get_data_length(const packet_t packet){
     111        if(! packet_is_valid(packet)){
    121112                return 0;
    122 
     113        }
    123114        return PACKET_DATA_LENGTH(packet);
    124115}
    125116
    126 void *packet_get_data(const packet_t packet)
    127 {
    128         if (!packet_is_valid(packet))
     117void * packet_get_data(const packet_t packet){
     118        if(! packet_is_valid(packet)){
    129119                return NULL;
    130 
     120        }
    131121        return (void *) packet + packet->data_start;
    132122}
    133123
    134 int
    135 packet_set_addr(packet_t packet, const uint8_t * src, const uint8_t * dest,
    136     size_t addr_len)
    137 {
     124int packet_set_addr(packet_t packet, const uint8_t * src, const uint8_t * dest, size_t addr_len){
    138125        size_t padding;
    139126        size_t allocated;
    140127
    141         if (!packet_is_valid(packet))
     128        if(! packet_is_valid(packet)){
    142129                return EINVAL;
    143 
     130        }
    144131        allocated = PACKET_MAX_ADDRESS_LENGTH(packet);
    145         if (allocated < addr_len)
     132        if(allocated < addr_len){
    146133                return ENOMEM;
    147 
     134        }
    148135        padding = allocated - addr_len;
    149136        packet->addr_len = addr_len;
    150 
    151         if (src) {
     137        if(src){
    152138                memcpy((void *) packet + packet->src_addr, src, addr_len);
    153                 if (padding)
    154                         bzero((void *) packet + packet->src_addr + addr_len,
    155                             padding);
    156         } else {
     139                if(padding){
     140                        bzero((void *) packet + packet->src_addr + addr_len, padding);
     141                }
     142        }else{
    157143                bzero((void *) packet + packet->src_addr, allocated);
    158144        }
    159 
    160         if (dest) {
     145        if(dest){
    161146                memcpy((void *) packet + packet->dest_addr, dest, addr_len);
    162                 if (padding)
    163                         bzero((void *) packet + packet->dest_addr + addr_len,
    164                             padding);
    165         } else {
     147                if(padding){
     148                        bzero((void *) packet + packet->dest_addr + addr_len, padding);
     149                }
     150        }else{
    166151                bzero((void *) packet + packet->dest_addr, allocated);
    167152        }
    168 
    169153        return EOK;
    170154}
    171155
    172 packet_t packet_get_copy(int phone, packet_t packet)
    173 {
     156packet_t packet_get_copy(int phone, packet_t packet){
    174157        packet_t copy;
    175158        uint8_t * src = NULL;
    … …  
    177160        size_t addrlen;
    178161
    179         if (!packet_is_valid(packet))
     162        if(! packet_is_valid(packet)){
    180163                return NULL;
    181 
     164        }
    182165        // get a new packet
    183         copy = packet_get_4_local(phone, PACKET_DATA_LENGTH(packet),
    184             PACKET_MAX_ADDRESS_LENGTH(packet), packet->max_prefix,
    185             PACKET_MIN_SUFFIX(packet));
    186         if (!copy)
     166        copy = packet_get_4_local(phone, PACKET_DATA_LENGTH(packet), PACKET_MAX_ADDRESS_LENGTH(packet), packet->max_prefix, PACKET_MIN_SUFFIX(packet));
     167        if(! copy){
    187168                return NULL;
    188 
     169        }
    189170        // get addresses
    190171        addrlen = packet_get_addr(packet, &src, &dest);
    191172        // copy data
    192         if ((packet_copy_data(copy, packet_get_data(packet),
    193             PACKET_DATA_LENGTH(packet)) == EOK) &&
    194             // copy addresses if present
    195             ((addrlen <= 0) ||
    196             (packet_set_addr(copy, src, dest, addrlen) == EOK))) {
     173        if((packet_copy_data(copy, packet_get_data(packet), PACKET_DATA_LENGTH(packet)) == EOK)
     174        // copy addresses if present
     175                && ((addrlen <= 0) || (packet_set_addr(copy, src, dest, addrlen) == EOK))){
    197176                copy->order = packet->order;
    198177                copy->metric = packet->metric;
    199178                return copy;
    200         } else {
     179        }else{
    201180                pq_release_local(phone, copy->packet_id);
    202181                return NULL;
Note: See TracChangeset for help on using the changeset viewer.