/*
* Mausezahn - A fast versatile traffic generator
* Copyright (C) 2008-2010 Herbert Haas
*
* This program is free software; you can redistribute it and/or modify it under
* the terms of the GNU General Public License version 2 as published by the
* Free Software Foundation.
*
* This program is distributed in the hope that it will be useful, but WITHOUT
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
* FOR A PARTICULAR PURPOSE. See the GNU General Public License for more
* details.
*
* You should have received a copy of the GNU General Public License along with
* this program; if not, see http://www.gnu.org/licenses/gpl-2.0.html
*
*/
#include "mz.h"
#include "mops.h"
// Remove 802.1Q tags from packet mp
//
// k indicates which tag to be removed (1..n)
// k=0 means: remove all tags!
//
// RETURN VALUE: 1 upon failure, 0 upon success
int mops_dot1Q_remove (struct mops *mp, int k)
{
int a,b,n;
if (k==0) {
mp->dot1Q_s=0;
mp->use_dot1Q=0;
return 0;
}
n = mp->dot1Q_s/4; // n = total number of tags
if (k>n) return 1;
if (k==1) { // only delete the single tag
mp->dot1Q_s=0;
mp->use_dot1Q=0;
return 0;
}
// we have more than one tag:
//
if (k==n) { // remove last tag (of several)
mp->dot1Q_s -=4;
return 0;
}
// remove some non-ending tag: 0, 1, 2, 3
a = (k-1)*4; // target
b = k*4; // source (what should be copied)
memcpy(&mp->dot1Q[a], &mp->dot1Q[b], (n-k)*4);
mp->dot1Q_s -=4;
return 0;
}
// Unset CFI in tag k where k=1..n
int mops_dot1Q_nocfi (struct mops *mp, int k)
{
int n;
n = mp->dot1Q_s/4; // n = total number of tags
if (k>n) return 1;
mp->dot1Q[((k-1)*4)+2] &=0xef; // unset CFI (0xef = 1110 1111)
return 0;
}
// Set CFI in tag k where k=1..n
int mops_dot1Q_cfi (struct mops *mp, int k)
{
int n;
n = mp->dot1Q_s/4; // n = total number of tags
if (k>n) return 1;
mp->dot1Q[((k-1)*4)+2] |=0x10; // set CFI (0x10 = 0001 0000)
return 0;
}
// Assign 802.1Q tag with
// v ... VLAN
// c ... CoS
// i ... tag position (starting from zero!)
//
// m ... modification: 1 = dot1Q_s is not changed
//
// NOTE:
// When called from for-loop to add all tags the total size dot1Q_s
// is updated continuously, therefore use m=1.
//
// But when changing a particular tag within an existing 802.1Q stack
// the total number of tags does not change, therefore use m=0.
//
// RETURN VALUE: 0 upon success, 1 upon failure
//
int mops_dot1Q (struct mops *mp, int i, int m, u_int16_t v, u_int16_t c)
{
u_int8_t *ptr, c8;
if (i>=MAX_MOPS_DOT1Q_TAGS) return 1; // max number of tags, see definitions in mops.h
if ((v>4095)||(c>7)) return 1; // greater values do not make sense
// Format: 0x8100 CoS-CFI-VLAN
// where c=CoS, v=VLAN
c8 = (u_int8_t) c;
mp->dot1Q[4*i+0]= 0x81;
mp->dot1Q[4*i+1]= 0x00;
ptr = (u_int8_t*) &v;
mp->dot1Q[4*i+3]=*ptr;
mp->dot1Q[4*i+2]=*(ptr+1);
mp->dot1Q[4*i+2]^= (c8 << 5);
if (m) {
mp->dot1Q_s=4*(1+i); // NOTE: dot1Q_s = current tag position + 1
if (mp->dot1Q_s) mp->use_dot1Q = 1;
}
return 0;
}
move&id=853277481178fdf14d1a4e9e6ac7174d6046176f'>usb/proc.c| Age | Commit message (Expand) | Author | Files | Lines |
|---|