/** * <tlv-block> * = <tlv-length> <tlv>* * <tlv> * = <type> <tlv-semantics> <length>? <index-start>? <index-stop>? <value>? */ static void build_tlv_msg(olsr_pktbuf_t *pktbuf, OLSR_LIST *tlv_block) { //Static Fix //static olsr_pktbuf_t *tlv_buf = NULL; olsr_pktbuf_t *tlv_buf = NULL; OLSR_LIST_ENTRY *p = NULL; olsr_u16_t extend_length; //wiss: initialisation du buffer temporaire qu'on va s'en servir tlv_buf = olsr_pktbuf_alloc_with_capa(64); olsr_pktbuf_clear(tlv_buf); for (p = tlv_block->head; p != NULL; p = p->next) { BASE_TLV *const tlv = (BASE_TLV *)p->data; olsr_pktbuf_append_u8(tlv_buf, tlv->tlv_type); olsr_pktbuf_append_u8(tlv_buf, tlv->tlv_semantics); //index start and stop if((tlv->tlv_semantics & NO_INDEX) == 0) { //wiss: hon bifout kell chi ella el NO_INDEX olsr_pktbuf_append_u8(tlv_buf, tlv->index_start); if((tlv->tlv_semantics & SINGLE_INDEX) == 0)// wiss: hon bifout kell chi ella el single index olsr_pktbuf_append_u8(tlv_buf, tlv->index_stop); // wiss: hon byetaba2 kell chi ella el no index wel single index ya3ni el tabi3i } //no value bit unset if((tlv->tlv_semantics & NO_VALUE) == 0) { // wiss: hon bifout kell chi ella NO_VALUE ya3ni bifout kell chi bass akid mech MPRSELECTOR //extended bit if((tlv->tlv_semantics & EXTENDED) == 0) // wiss: chou extended ma fhemet ma mar2et wala marra !! olsr_pktbuf_append_u8(tlv_buf, tlv->tlv_length); else { extend_length = tlv->tlv_length; olsr_pktbuf_append_u16(tlv_buf, htons(extend_length)); } } // value if((tlv->tlv_semantics & NO_VALUE) == 0) olsr_pktbuf_append_byte_ary(tlv_buf, tlv->value, tlv->tlv_length); //multi value bit unsupported } olsr_pktbuf_append_u16(pktbuf, (olsr_u16_t)tlv_buf->len); olsr_pktbuf_append_pktbuf(pktbuf, tlv_buf); //XXX:debug_code(print_tlv_msg(msg_head)); olsr_pktbuf_free(&tlv_buf); //free(tlv_buf->data); //free(tlv_buf); }
void forward_message(struct olsrv2 *olsr) { const struct message_header* m_header = &olsr->message_header; olsr_pktbuf_t* msg = NULL; msg = olsr_pktbuf_alloc(); olsr_pktbuf_clear(msg); /* TC should be forwarded all interface. but now, we forward only one interface. I'll correct later... */ build_message_header(olsr, msg, (olsr_u16_t)olsr->message_body_size, m_header->message_type, &m_header->orig_addr, m_header->ttl - 1, m_header->hop_count + 1, m_header->message_seq_num); if (m_header->message_type == TC_MESSAGE){ olsr->stat.numTcRelayed++; if (DEBUG_OLSRV2){ olsr_printf("Increment TC relayed to %d.\n",olsr->stat.numTcRelayed); } } olsr_pktbuf_append_byte_ary(msg, (olsr_u8_t* )olsr->message_body, olsr->message_body_size); if (DEBUG_OLSRV2){ olsr_printf("TTL:%d\nhopcount:%d\nmsg_size:%d\n",m_header->ttl - 1, m_header->hop_count + 1, (int)msg->len); } if (m_header->message_type == TC_MESSAGE) { int ifNum; for(ifNum=0; ifNum<olsr->iface_num; ifNum++) { set_forward_infomation(olsr, msg->data, (unsigned int)msg->len, (unsigned char)ifNum); } } else { set_forward_infomation(olsr, msg->data, (unsigned int)msg->len, olsr->parsingIfNum); } olsr_pktbuf_free(&msg); }
/* * Create <tlv> */ static void create_simple_tlv(olsr_pktbuf_t *buf, const olsr_u8_t type, const olsr_u8_t tlv_semantics, const olsr_u8_t length, const olsr_u8_t index_start, const olsr_u8_t index_stop, const olsr_u8_t *value) { olsr_u16_t extend_length; olsr_pktbuf_append_u8(buf, type); olsr_pktbuf_append_u8(buf, tlv_semantics); //index start and stop if((tlv_semantics & NO_INDEX) == 0) { olsr_pktbuf_append_u8(buf, index_start); if((tlv_semantics & SINGLE_INDEX) == 0) olsr_pktbuf_append_u8(buf, index_stop); } //no value bit unset if((tlv_semantics & NO_VALUE) == 0) { //extend bit if((tlv_semantics & EXTENDED) == 0) olsr_pktbuf_append_u8(buf, length); else { extend_length = length; olsr_pktbuf_append_u16(buf, htons(extend_length)); } } // value if((tlv_semantics & NO_VALUE) == 0) //olsr_pktbuf_append_u8(buf, value); olsr_pktbuf_append_byte_ary(buf, value, length); //multi value bit unsupported }
olsr_bool olsr_pktbuf_append_pktbuf(olsr_pktbuf_t *self, const olsr_pktbuf_t *src) { return olsr_pktbuf_append_byte_ary(self, src->data, src->len); }
olsr_bool olsr_pktbuf_append_ip(struct olsrv2* olsr, olsr_pktbuf_t *self, const union olsr_ip_addr *ip) { struct olsrd_config* olsr_cnf = ((struct olsrv2*)olsr)->olsr_cnf; return olsr_pktbuf_append_byte_ary(self, (const olsr_u8_t*)ip, IP_LEN); }