Subversion Repositories HelenOS

Rev

Rev 4505 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 4505 Rev 4731
Line 69... Line 69...
69 
    return ( void * ) packet + packet->data_end - length;
 69 
    return ( void * ) packet + packet->data_end - length;
70 
}
 70 
}
71 
 
 71 
 
72 
int packet_trim( packet_t packet, size_t prefix, size_t suffix ){
 72 
int packet_trim( packet_t packet, size_t prefix, size_t suffix ){
73 
    if( ! packet_is_valid( packet )) return EINVAL;
 73 
    if( ! packet_is_valid( packet )) return EINVAL;
74 
    if( prefix + suffix > packet->data_end - packet->data_start ) return ENOMEM;
 74 
    if( prefix + suffix > PACKET_DATA_LENGTH( packet )) return ENOMEM;
75 
    packet->data_start += prefix;
 75 
    packet->data_start += prefix;
76 
    packet->data_end -= suffix;
 76 
    packet->data_end -= suffix;
77 
    return EOK;
 77 
    return EOK;
78 
}
 78 
}
79 
 
 79 
 
Line 89... Line 89...
89 
    return packet->addr_len;
 89 
    return packet->addr_len;
90 
}
 90 
}
91 
 
 91 
 
92 
size_t packet_get_data_length( const packet_t packet ){
 92 
size_t packet_get_data_length( const packet_t packet ){
93 
    if( ! packet_is_valid( packet )) return 0;
 93 
    if( ! packet_is_valid( packet )) return 0;
94 
    return packet->data_end - packet->data_start;
 94 
    return PACKET_DATA_LENGTH( packet );
95 
}
 95 
}
96 
 
 96 
 
97 
void * packet_get_data( const packet_t packet ){
 97 
void * packet_get_data( const packet_t packet ){
98 
    if( ! packet_is_valid( packet )) return NULL;
 98 
    if( ! packet_is_valid( packet )) return NULL;
99 
    return ( void * ) packet + packet->data_start;
 99 
    return ( void * ) packet + packet->data_start;
Line 102... Line 102...
102 
int packet_set_addr( packet_t packet, const uint8_t * src, const uint8_t * dest, size_t addr_len ){
 102 
int packet_set_addr( packet_t packet, const uint8_t * src, const uint8_t * dest, size_t addr_len ){
103 
    size_t  padding;
 103 
    size_t  padding;
104 
    size_t  allocated;
 104 
    size_t  allocated;
105 
 
 105 
 
106 
    if( ! packet_is_valid( packet )) return EINVAL;
 106 
    if( ! packet_is_valid( packet )) return EINVAL;
107 
    allocated = packet->dest_addr - packet->src_addr;
 107 
    allocated = PACKET_MAX_ADDRESS_LENGTH( packet );
108 
    if( allocated < addr_len ) return ENOMEM;
 108 
    if( allocated < addr_len ) return ENOMEM;
109 
    padding = allocated - addr_len;
 109 
    padding = allocated - addr_len;
110 
    packet->addr_len = addr_len;
 110 
    packet->addr_len = addr_len;
111 
    if( src ){
 111 
    if( src ){
112 
        memcpy(( void * ) packet + packet->src_addr, src, addr_len );
 112 
        memcpy(( void * ) packet + packet->src_addr, src, addr_len );
Line 121... Line 121...
121 
        bzero(( void * ) packet + packet->dest_addr, allocated );
 121 
        bzero(( void * ) packet + packet->dest_addr, allocated );
122 
    }
 122 
    }
123 
    return EOK;
 123 
    return EOK;
124 
}
 124 
}
125 
 
 125 
 
- 
 
 126 
packet_t packet_get_copy( int phone, packet_t packet ){
- 
 
 127 
    packet_t    copy;
- 
 
 128 
    uint8_t *   src;
- 
 
 129 
    uint8_t *   dest;
- 
 
 130 
    size_t      addrlen;
- 
 
 131 
 
- 
 
 132 
    if( ! packet_is_valid( packet )) return NULL;
- 
 
 133 
    // get a new packet
- 
 
 134 
    copy = packet_get_4( phone, PACKET_DATA_LENGTH( packet ), PACKET_MAX_ADDRESS_LENGTH( packet ), packet->max_prefix, PACKET_MIN_SUFFIX( packet ));
- 
 
 135 
    if( ! copy ) return NULL;
- 
 
 136 
    // get addresses
- 
 
 137 
    addrlen = packet_get_addr( packet, & src, & dest );
- 
 
 138 
    // copy data
- 
 
 139 
    if(( packet_copy_data( copy, packet_get_data( packet ), PACKET_DATA_LENGTH( packet )) == EOK )
- 
 
 140 
    // copy addresses if present
- 
 
 141 
    && (( addrlen <= 0 ) || ( packet_set_addr( copy, src, dest, addrlen ) == EOK ))){
- 
 
 142 
        copy->order = packet->order;
- 
 
 143 
        copy->metric = packet->metric;
- 
 
 144 
        return copy;
- 
 
 145 
    }else{
- 
 
 146 
        pq_release( phone, copy->packet_id );
- 
 
 147 
        return NULL;
- 
 
 148 
    }
- 
 
 149 
}
- 
 
 150 
 
126 
/** @}
 151 
/** @}
127 
 */
 152 
 */