2685 lines
66 KiB
C
2685 lines
66 KiB
C
|
// SPDX-License-Identifier: GPL-2.0
|
||
|
/* Copyright (c) 2013, Intel Corporation. */
|
||
|
|
||
|
#include "kcompat.h"
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,4,8) ) || defined __VMKLNX__
|
||
|
/* From lib/vsprintf.c */
|
||
|
#include <asm/div64.h>
|
||
|
|
||
|
static int skip_atoi(const char **s)
|
||
|
{
|
||
|
int i=0;
|
||
|
|
||
|
while (isdigit(**s))
|
||
|
i = i*10 + *((*s)++) - '0';
|
||
|
return i;
|
||
|
}
|
||
|
|
||
|
#define _kc_ZEROPAD 1 /* pad with zero */
|
||
|
#define _kc_SIGN 2 /* unsigned/signed long */
|
||
|
#define _kc_PLUS 4 /* show plus */
|
||
|
#define _kc_SPACE 8 /* space if plus */
|
||
|
#define _kc_LEFT 16 /* left justified */
|
||
|
#define _kc_SPECIAL 32 /* 0x */
|
||
|
#define _kc_LARGE 64 /* use 'ABCDEF' instead of 'abcdef' */
|
||
|
|
||
|
static char * number(char * buf, char * end, long long num, int base, int size, int precision, int type)
|
||
|
{
|
||
|
char c,sign,tmp[66];
|
||
|
const char *digits;
|
||
|
const char small_digits[] = "0123456789abcdefghijklmnopqrstuvwxyz";
|
||
|
const char large_digits[] = "0123456789ABCDEFGHIJKLMNOPQRSTUVWXYZ";
|
||
|
int i;
|
||
|
|
||
|
digits = (type & _kc_LARGE) ? large_digits : small_digits;
|
||
|
if (type & _kc_LEFT)
|
||
|
type &= ~_kc_ZEROPAD;
|
||
|
if (base < 2 || base > 36)
|
||
|
return 0;
|
||
|
c = (type & _kc_ZEROPAD) ? '0' : ' ';
|
||
|
sign = 0;
|
||
|
if (type & _kc_SIGN) {
|
||
|
if (num < 0) {
|
||
|
sign = '-';
|
||
|
num = -num;
|
||
|
size--;
|
||
|
} else if (type & _kc_PLUS) {
|
||
|
sign = '+';
|
||
|
size--;
|
||
|
} else if (type & _kc_SPACE) {
|
||
|
sign = ' ';
|
||
|
size--;
|
||
|
}
|
||
|
}
|
||
|
if (type & _kc_SPECIAL) {
|
||
|
if (base == 16)
|
||
|
size -= 2;
|
||
|
else if (base == 8)
|
||
|
size--;
|
||
|
}
|
||
|
i = 0;
|
||
|
if (num == 0)
|
||
|
tmp[i++]='0';
|
||
|
else while (num != 0)
|
||
|
tmp[i++] = digits[do_div(num,base)];
|
||
|
if (i > precision)
|
||
|
precision = i;
|
||
|
size -= precision;
|
||
|
if (!(type&(_kc_ZEROPAD+_kc_LEFT))) {
|
||
|
while(size-->0) {
|
||
|
if (buf <= end)
|
||
|
*buf = ' ';
|
||
|
++buf;
|
||
|
}
|
||
|
}
|
||
|
if (sign) {
|
||
|
if (buf <= end)
|
||
|
*buf = sign;
|
||
|
++buf;
|
||
|
}
|
||
|
if (type & _kc_SPECIAL) {
|
||
|
if (base==8) {
|
||
|
if (buf <= end)
|
||
|
*buf = '0';
|
||
|
++buf;
|
||
|
} else if (base==16) {
|
||
|
if (buf <= end)
|
||
|
*buf = '0';
|
||
|
++buf;
|
||
|
if (buf <= end)
|
||
|
*buf = digits[33];
|
||
|
++buf;
|
||
|
}
|
||
|
}
|
||
|
if (!(type & _kc_LEFT)) {
|
||
|
while (size-- > 0) {
|
||
|
if (buf <= end)
|
||
|
*buf = c;
|
||
|
++buf;
|
||
|
}
|
||
|
}
|
||
|
while (i < precision--) {
|
||
|
if (buf <= end)
|
||
|
*buf = '0';
|
||
|
++buf;
|
||
|
}
|
||
|
while (i-- > 0) {
|
||
|
if (buf <= end)
|
||
|
*buf = tmp[i];
|
||
|
++buf;
|
||
|
}
|
||
|
while (size-- > 0) {
|
||
|
if (buf <= end)
|
||
|
*buf = ' ';
|
||
|
++buf;
|
||
|
}
|
||
|
return buf;
|
||
|
}
|
||
|
|
||
|
int _kc_vsnprintf(char *buf, size_t size, const char *fmt, va_list args)
|
||
|
{
|
||
|
int len;
|
||
|
unsigned long long num;
|
||
|
int i, base;
|
||
|
char *str, *end, c;
|
||
|
const char *s;
|
||
|
|
||
|
int flags; /* flags to number() */
|
||
|
|
||
|
int field_width; /* width of output field */
|
||
|
int precision; /* min. # of digits for integers; max
|
||
|
number of chars for from string */
|
||
|
int qualifier; /* 'h', 'l', or 'L' for integer fields */
|
||
|
/* 'z' support added 23/7/1999 S.H. */
|
||
|
/* 'z' changed to 'Z' --davidm 1/25/99 */
|
||
|
|
||
|
str = buf;
|
||
|
end = buf + size - 1;
|
||
|
|
||
|
if (end < buf - 1) {
|
||
|
end = ((void *) -1);
|
||
|
size = end - buf + 1;
|
||
|
}
|
||
|
|
||
|
for (; *fmt ; ++fmt) {
|
||
|
if (*fmt != '%') {
|
||
|
if (str <= end)
|
||
|
*str = *fmt;
|
||
|
++str;
|
||
|
continue;
|
||
|
}
|
||
|
|
||
|
/* process flags */
|
||
|
flags = 0;
|
||
|
repeat:
|
||
|
++fmt; /* this also skips first '%' */
|
||
|
switch (*fmt) {
|
||
|
case '-': flags |= _kc_LEFT; goto repeat;
|
||
|
case '+': flags |= _kc_PLUS; goto repeat;
|
||
|
case ' ': flags |= _kc_SPACE; goto repeat;
|
||
|
case '#': flags |= _kc_SPECIAL; goto repeat;
|
||
|
case '0': flags |= _kc_ZEROPAD; goto repeat;
|
||
|
}
|
||
|
|
||
|
/* get field width */
|
||
|
field_width = -1;
|
||
|
if (isdigit(*fmt))
|
||
|
field_width = skip_atoi(&fmt);
|
||
|
else if (*fmt == '*') {
|
||
|
++fmt;
|
||
|
/* it's the next argument */
|
||
|
field_width = va_arg(args, int);
|
||
|
if (field_width < 0) {
|
||
|
field_width = -field_width;
|
||
|
flags |= _kc_LEFT;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* get the precision */
|
||
|
precision = -1;
|
||
|
if (*fmt == '.') {
|
||
|
++fmt;
|
||
|
if (isdigit(*fmt))
|
||
|
precision = skip_atoi(&fmt);
|
||
|
else if (*fmt == '*') {
|
||
|
++fmt;
|
||
|
/* it's the next argument */
|
||
|
precision = va_arg(args, int);
|
||
|
}
|
||
|
if (precision < 0)
|
||
|
precision = 0;
|
||
|
}
|
||
|
|
||
|
/* get the conversion qualifier */
|
||
|
qualifier = -1;
|
||
|
if (*fmt == 'h' || *fmt == 'l' || *fmt == 'L' || *fmt =='Z') {
|
||
|
qualifier = *fmt;
|
||
|
++fmt;
|
||
|
}
|
||
|
|
||
|
/* default base */
|
||
|
base = 10;
|
||
|
|
||
|
switch (*fmt) {
|
||
|
case 'c':
|
||
|
if (!(flags & _kc_LEFT)) {
|
||
|
while (--field_width > 0) {
|
||
|
if (str <= end)
|
||
|
*str = ' ';
|
||
|
++str;
|
||
|
}
|
||
|
}
|
||
|
c = (unsigned char) va_arg(args, int);
|
||
|
if (str <= end)
|
||
|
*str = c;
|
||
|
++str;
|
||
|
while (--field_width > 0) {
|
||
|
if (str <= end)
|
||
|
*str = ' ';
|
||
|
++str;
|
||
|
}
|
||
|
continue;
|
||
|
|
||
|
case 's':
|
||
|
s = va_arg(args, char *);
|
||
|
if (!s)
|
||
|
s = "<NULL>";
|
||
|
|
||
|
len = strnlen(s, precision);
|
||
|
|
||
|
if (!(flags & _kc_LEFT)) {
|
||
|
while (len < field_width--) {
|
||
|
if (str <= end)
|
||
|
*str = ' ';
|
||
|
++str;
|
||
|
}
|
||
|
}
|
||
|
for (i = 0; i < len; ++i) {
|
||
|
if (str <= end)
|
||
|
*str = *s;
|
||
|
++str; ++s;
|
||
|
}
|
||
|
while (len < field_width--) {
|
||
|
if (str <= end)
|
||
|
*str = ' ';
|
||
|
++str;
|
||
|
}
|
||
|
continue;
|
||
|
|
||
|
case 'p':
|
||
|
if ('M' == *(fmt+1)) {
|
||
|
str = get_mac(str, end, va_arg(args, unsigned char *));
|
||
|
fmt++;
|
||
|
} else {
|
||
|
if (field_width == -1) {
|
||
|
field_width = 2*sizeof(void *);
|
||
|
flags |= _kc_ZEROPAD;
|
||
|
}
|
||
|
str = number(str, end,
|
||
|
(unsigned long) va_arg(args, void *),
|
||
|
16, field_width, precision, flags);
|
||
|
}
|
||
|
continue;
|
||
|
|
||
|
case 'n':
|
||
|
/* FIXME:
|
||
|
* What does C99 say about the overflow case here? */
|
||
|
if (qualifier == 'l') {
|
||
|
long * ip = va_arg(args, long *);
|
||
|
*ip = (str - buf);
|
||
|
} else if (qualifier == 'Z') {
|
||
|
size_t * ip = va_arg(args, size_t *);
|
||
|
*ip = (str - buf);
|
||
|
} else {
|
||
|
int * ip = va_arg(args, int *);
|
||
|
*ip = (str - buf);
|
||
|
}
|
||
|
continue;
|
||
|
|
||
|
case '%':
|
||
|
if (str <= end)
|
||
|
*str = '%';
|
||
|
++str;
|
||
|
continue;
|
||
|
|
||
|
/* integer number formats - set up the flags and "break" */
|
||
|
case 'o':
|
||
|
base = 8;
|
||
|
break;
|
||
|
|
||
|
case 'X':
|
||
|
flags |= _kc_LARGE;
|
||
|
case 'x':
|
||
|
base = 16;
|
||
|
break;
|
||
|
|
||
|
case 'd':
|
||
|
case 'i':
|
||
|
flags |= _kc_SIGN;
|
||
|
case 'u':
|
||
|
break;
|
||
|
|
||
|
default:
|
||
|
if (str <= end)
|
||
|
*str = '%';
|
||
|
++str;
|
||
|
if (*fmt) {
|
||
|
if (str <= end)
|
||
|
*str = *fmt;
|
||
|
++str;
|
||
|
} else {
|
||
|
--fmt;
|
||
|
}
|
||
|
continue;
|
||
|
}
|
||
|
if (qualifier == 'L')
|
||
|
num = va_arg(args, long long);
|
||
|
else if (qualifier == 'l') {
|
||
|
num = va_arg(args, unsigned long);
|
||
|
if (flags & _kc_SIGN)
|
||
|
num = (signed long) num;
|
||
|
} else if (qualifier == 'Z') {
|
||
|
num = va_arg(args, size_t);
|
||
|
} else if (qualifier == 'h') {
|
||
|
num = (unsigned short) va_arg(args, int);
|
||
|
if (flags & _kc_SIGN)
|
||
|
num = (signed short) num;
|
||
|
} else {
|
||
|
num = va_arg(args, unsigned int);
|
||
|
if (flags & _kc_SIGN)
|
||
|
num = (signed int) num;
|
||
|
}
|
||
|
str = number(str, end, num, base,
|
||
|
field_width, precision, flags);
|
||
|
}
|
||
|
if (str <= end)
|
||
|
*str = '\0';
|
||
|
else if (size > 0)
|
||
|
/* don't write out a null byte if the buf size is zero */
|
||
|
*end = '\0';
|
||
|
/* the trailing null byte doesn't count towards the total
|
||
|
* ++str;
|
||
|
*/
|
||
|
return str-buf;
|
||
|
}
|
||
|
|
||
|
int _kc_snprintf(char * buf, size_t size, const char *fmt, ...)
|
||
|
{
|
||
|
va_list args;
|
||
|
int i;
|
||
|
|
||
|
va_start(args, fmt);
|
||
|
i = _kc_vsnprintf(buf,size,fmt,args);
|
||
|
va_end(args);
|
||
|
return i;
|
||
|
}
|
||
|
#endif /* < 2.4.8 */
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,4,13) )
|
||
|
|
||
|
/**************************************/
|
||
|
/* PCI DMA MAPPING */
|
||
|
|
||
|
#if defined(CONFIG_HIGHMEM)
|
||
|
|
||
|
#ifndef PCI_DRAM_OFFSET
|
||
|
#define PCI_DRAM_OFFSET 0
|
||
|
#endif
|
||
|
|
||
|
u64
|
||
|
_kc_pci_map_page(struct pci_dev *dev, struct page *page, unsigned long offset,
|
||
|
size_t size, int direction)
|
||
|
{
|
||
|
return (((u64) (page - mem_map) << PAGE_SHIFT) + offset +
|
||
|
PCI_DRAM_OFFSET);
|
||
|
}
|
||
|
|
||
|
#else /* CONFIG_HIGHMEM */
|
||
|
|
||
|
u64
|
||
|
_kc_pci_map_page(struct pci_dev *dev, struct page *page, unsigned long offset,
|
||
|
size_t size, int direction)
|
||
|
{
|
||
|
return pci_map_single(dev, (void *)page_address(page) + offset, size,
|
||
|
direction);
|
||
|
}
|
||
|
|
||
|
#endif /* CONFIG_HIGHMEM */
|
||
|
|
||
|
void
|
||
|
_kc_pci_unmap_page(struct pci_dev *dev, u64 dma_addr, size_t size,
|
||
|
int direction)
|
||
|
{
|
||
|
return pci_unmap_single(dev, dma_addr, size, direction);
|
||
|
}
|
||
|
|
||
|
#endif /* 2.4.13 => 2.4.3 */
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,4,3) )
|
||
|
|
||
|
/**************************************/
|
||
|
/* PCI DRIVER API */
|
||
|
|
||
|
int
|
||
|
_kc_pci_set_dma_mask(struct pci_dev *dev, dma_addr_t mask)
|
||
|
{
|
||
|
if (!pci_dma_supported(dev, mask))
|
||
|
return -EIO;
|
||
|
dev->dma_mask = mask;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
int
|
||
|
_kc_pci_request_regions(struct pci_dev *dev, char *res_name)
|
||
|
{
|
||
|
int i;
|
||
|
|
||
|
for (i = 0; i < 6; i++) {
|
||
|
if (pci_resource_len(dev, i) == 0)
|
||
|
continue;
|
||
|
|
||
|
if (pci_resource_flags(dev, i) & IORESOURCE_IO) {
|
||
|
if (!request_region(pci_resource_start(dev, i), pci_resource_len(dev, i), res_name)) {
|
||
|
pci_release_regions(dev);
|
||
|
return -EBUSY;
|
||
|
}
|
||
|
} else if (pci_resource_flags(dev, i) & IORESOURCE_MEM) {
|
||
|
if (!request_mem_region(pci_resource_start(dev, i), pci_resource_len(dev, i), res_name)) {
|
||
|
pci_release_regions(dev);
|
||
|
return -EBUSY;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
void
|
||
|
_kc_pci_release_regions(struct pci_dev *dev)
|
||
|
{
|
||
|
int i;
|
||
|
|
||
|
for (i = 0; i < 6; i++) {
|
||
|
if (pci_resource_len(dev, i) == 0)
|
||
|
continue;
|
||
|
|
||
|
if (pci_resource_flags(dev, i) & IORESOURCE_IO)
|
||
|
release_region(pci_resource_start(dev, i), pci_resource_len(dev, i));
|
||
|
|
||
|
else if (pci_resource_flags(dev, i) & IORESOURCE_MEM)
|
||
|
release_mem_region(pci_resource_start(dev, i), pci_resource_len(dev, i));
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/**************************************/
|
||
|
/* NETWORK DRIVER API */
|
||
|
|
||
|
struct net_device *
|
||
|
_kc_alloc_etherdev(int sizeof_priv)
|
||
|
{
|
||
|
struct net_device *dev;
|
||
|
int alloc_size;
|
||
|
|
||
|
alloc_size = sizeof(*dev) + sizeof_priv + IFNAMSIZ + 31;
|
||
|
dev = kzalloc(alloc_size, GFP_KERNEL);
|
||
|
if (!dev)
|
||
|
return NULL;
|
||
|
|
||
|
if (sizeof_priv)
|
||
|
dev->priv = (void *) (((unsigned long)(dev + 1) + 31) & ~31);
|
||
|
dev->name[0] = '\0';
|
||
|
ether_setup(dev);
|
||
|
|
||
|
return dev;
|
||
|
}
|
||
|
|
||
|
int
|
||
|
_kc_is_valid_ether_addr(u8 *addr)
|
||
|
{
|
||
|
const char zaddr[6] = { 0, };
|
||
|
|
||
|
return !(addr[0] & 1) && memcmp(addr, zaddr, 6);
|
||
|
}
|
||
|
|
||
|
#endif /* 2.4.3 => 2.4.0 */
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,4,6) )
|
||
|
|
||
|
int
|
||
|
_kc_pci_set_power_state(struct pci_dev *dev, int state)
|
||
|
{
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
int
|
||
|
_kc_pci_enable_wake(struct pci_dev *pdev, u32 state, int enable)
|
||
|
{
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
#endif /* 2.4.6 => 2.4.3 */
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,6,0) )
|
||
|
void _kc_skb_fill_page_desc(struct sk_buff *skb, int i, struct page *page,
|
||
|
int off, int size)
|
||
|
{
|
||
|
skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
|
||
|
frag->page = page;
|
||
|
frag->page_offset = off;
|
||
|
frag->size = size;
|
||
|
skb_shinfo(skb)->nr_frags = i + 1;
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* Original Copyright:
|
||
|
* find_next_bit.c: fallback find next bit implementation
|
||
|
*
|
||
|
* Copyright (C) 2004 Red Hat, Inc. All Rights Reserved.
|
||
|
* Written by David Howells (dhowells@redhat.com)
|
||
|
*/
|
||
|
|
||
|
/**
|
||
|
* find_next_bit - find the next set bit in a memory region
|
||
|
* @addr: The address to base the search on
|
||
|
* @offset: The bitnumber to start searching at
|
||
|
* @size: The maximum size to search
|
||
|
*/
|
||
|
unsigned long find_next_bit(const unsigned long *addr, unsigned long size,
|
||
|
unsigned long offset)
|
||
|
{
|
||
|
const unsigned long *p = addr + BITOP_WORD(offset);
|
||
|
unsigned long result = offset & ~(BITS_PER_LONG-1);
|
||
|
unsigned long tmp;
|
||
|
|
||
|
if (offset >= size)
|
||
|
return size;
|
||
|
size -= result;
|
||
|
offset %= BITS_PER_LONG;
|
||
|
if (offset) {
|
||
|
tmp = *(p++);
|
||
|
tmp &= (~0UL << offset);
|
||
|
if (size < BITS_PER_LONG)
|
||
|
goto found_first;
|
||
|
if (tmp)
|
||
|
goto found_middle;
|
||
|
size -= BITS_PER_LONG;
|
||
|
result += BITS_PER_LONG;
|
||
|
}
|
||
|
while (size & ~(BITS_PER_LONG-1)) {
|
||
|
if ((tmp = *(p++)))
|
||
|
goto found_middle;
|
||
|
result += BITS_PER_LONG;
|
||
|
size -= BITS_PER_LONG;
|
||
|
}
|
||
|
if (!size)
|
||
|
return result;
|
||
|
tmp = *p;
|
||
|
|
||
|
found_first:
|
||
|
tmp &= (~0UL >> (BITS_PER_LONG - size));
|
||
|
if (tmp == 0UL) /* Are any bits set? */
|
||
|
return result + size; /* Nope. */
|
||
|
found_middle:
|
||
|
return result + ffs(tmp);
|
||
|
}
|
||
|
|
||
|
size_t _kc_strlcpy(char *dest, const char *src, size_t size)
|
||
|
{
|
||
|
size_t ret = strlen(src);
|
||
|
|
||
|
if (size) {
|
||
|
size_t len = (ret >= size) ? size - 1 : ret;
|
||
|
memcpy(dest, src, len);
|
||
|
dest[len] = '\0';
|
||
|
}
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
#ifndef do_div
|
||
|
#if BITS_PER_LONG == 32
|
||
|
uint32_t __attribute__((weak)) _kc__div64_32(uint64_t *n, uint32_t base)
|
||
|
{
|
||
|
uint64_t rem = *n;
|
||
|
uint64_t b = base;
|
||
|
uint64_t res, d = 1;
|
||
|
uint32_t high = rem >> 32;
|
||
|
|
||
|
/* Reduce the thing a bit first */
|
||
|
res = 0;
|
||
|
if (high >= base) {
|
||
|
high /= base;
|
||
|
res = (uint64_t) high << 32;
|
||
|
rem -= (uint64_t) (high*base) << 32;
|
||
|
}
|
||
|
|
||
|
while ((int64_t)b > 0 && b < rem) {
|
||
|
b = b+b;
|
||
|
d = d+d;
|
||
|
}
|
||
|
|
||
|
do {
|
||
|
if (rem >= b) {
|
||
|
rem -= b;
|
||
|
res += d;
|
||
|
}
|
||
|
b >>= 1;
|
||
|
d >>= 1;
|
||
|
} while (d);
|
||
|
|
||
|
*n = res;
|
||
|
return rem;
|
||
|
}
|
||
|
#endif /* BITS_PER_LONG == 32 */
|
||
|
#endif /* do_div */
|
||
|
#endif /* 2.6.0 => 2.4.6 */
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,6,4) )
|
||
|
int _kc_scnprintf(char * buf, size_t size, const char *fmt, ...)
|
||
|
{
|
||
|
va_list args;
|
||
|
int i;
|
||
|
|
||
|
va_start(args, fmt);
|
||
|
i = vsnprintf(buf, size, fmt, args);
|
||
|
va_end(args);
|
||
|
return (i >= size) ? (size - 1) : i;
|
||
|
}
|
||
|
#endif /* < 2.6.4 */
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,6,10) )
|
||
|
DECLARE_BITMAP(_kcompat_node_online_map, MAX_NUMNODES) = {1};
|
||
|
#endif /* < 2.6.10 */
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,6,13) )
|
||
|
char *_kc_kstrdup(const char *s, unsigned int gfp)
|
||
|
{
|
||
|
size_t len;
|
||
|
char *buf;
|
||
|
|
||
|
if (!s)
|
||
|
return NULL;
|
||
|
|
||
|
len = strlen(s) + 1;
|
||
|
buf = kmalloc(len, gfp);
|
||
|
if (buf)
|
||
|
memcpy(buf, s, len);
|
||
|
return buf;
|
||
|
}
|
||
|
#endif /* < 2.6.13 */
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,6,14) )
|
||
|
void *_kc_kzalloc(size_t size, int flags)
|
||
|
{
|
||
|
void *ret = kmalloc(size, flags);
|
||
|
if (ret)
|
||
|
memset(ret, 0, size);
|
||
|
return ret;
|
||
|
}
|
||
|
#endif /* <= 2.6.13 */
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,6,19) )
|
||
|
int _kc_skb_pad(struct sk_buff *skb, int pad)
|
||
|
{
|
||
|
int ntail;
|
||
|
|
||
|
/* If the skbuff is non linear tailroom is always zero.. */
|
||
|
if(!skb_cloned(skb) && skb_tailroom(skb) >= pad) {
|
||
|
memset(skb->data+skb->len, 0, pad);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
ntail = skb->data_len + pad - (skb->end - skb->tail);
|
||
|
if (likely(skb_cloned(skb) || ntail > 0)) {
|
||
|
if (pskb_expand_head(skb, 0, ntail, GFP_ATOMIC))
|
||
|
goto free_skb;
|
||
|
}
|
||
|
|
||
|
#ifdef MAX_SKB_FRAGS
|
||
|
if (skb_is_nonlinear(skb) &&
|
||
|
!__pskb_pull_tail(skb, skb->data_len))
|
||
|
goto free_skb;
|
||
|
|
||
|
#endif
|
||
|
memset(skb->data + skb->len, 0, pad);
|
||
|
return 0;
|
||
|
|
||
|
free_skb:
|
||
|
kfree_skb(skb);
|
||
|
return -ENOMEM;
|
||
|
}
|
||
|
|
||
|
#if (!(RHEL_RELEASE_CODE && RHEL_RELEASE_CODE >= RHEL_RELEASE_VERSION(5,4)))
|
||
|
int _kc_pci_save_state(struct pci_dev *pdev)
|
||
|
{
|
||
|
struct net_device *netdev = pci_get_drvdata(pdev);
|
||
|
struct adapter_struct *adapter = netdev_priv(netdev);
|
||
|
int size = PCI_CONFIG_SPACE_LEN, i;
|
||
|
u16 pcie_cap_offset, pcie_link_status;
|
||
|
|
||
|
#if ( LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0) )
|
||
|
/* no ->dev for 2.4 kernels */
|
||
|
WARN_ON(pdev->dev.driver_data == NULL);
|
||
|
#endif
|
||
|
pcie_cap_offset = pci_find_capability(pdev, PCI_CAP_ID_EXP);
|
||
|
if (pcie_cap_offset) {
|
||
|
if (!pci_read_config_word(pdev,
|
||
|
pcie_cap_offset + PCIE_LINK_STATUS,
|
||
|
&pcie_link_status))
|
||
|
size = PCIE_CONFIG_SPACE_LEN;
|
||
|
}
|
||
|
pci_config_space_ich8lan();
|
||
|
#ifdef HAVE_PCI_ERS
|
||
|
if (adapter->config_space == NULL)
|
||
|
#else
|
||
|
WARN_ON(adapter->config_space != NULL);
|
||
|
#endif
|
||
|
adapter->config_space = kmalloc(size, GFP_KERNEL);
|
||
|
if (!adapter->config_space) {
|
||
|
printk(KERN_ERR "Out of memory in pci_save_state\n");
|
||
|
return -ENOMEM;
|
||
|
}
|
||
|
for (i = 0; i < (size / 4); i++)
|
||
|
pci_read_config_dword(pdev, i * 4, &adapter->config_space[i]);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
void _kc_pci_restore_state(struct pci_dev *pdev)
|
||
|
{
|
||
|
struct net_device *netdev = pci_get_drvdata(pdev);
|
||
|
struct adapter_struct *adapter = netdev_priv(netdev);
|
||
|
int size = PCI_CONFIG_SPACE_LEN, i;
|
||
|
u16 pcie_cap_offset;
|
||
|
u16 pcie_link_status;
|
||
|
|
||
|
if (adapter->config_space != NULL) {
|
||
|
pcie_cap_offset = pci_find_capability(pdev, PCI_CAP_ID_EXP);
|
||
|
if (pcie_cap_offset &&
|
||
|
!pci_read_config_word(pdev,
|
||
|
pcie_cap_offset + PCIE_LINK_STATUS,
|
||
|
&pcie_link_status))
|
||
|
size = PCIE_CONFIG_SPACE_LEN;
|
||
|
|
||
|
pci_config_space_ich8lan();
|
||
|
for (i = 0; i < (size / 4); i++)
|
||
|
pci_write_config_dword(pdev, i * 4, adapter->config_space[i]);
|
||
|
#ifndef HAVE_PCI_ERS
|
||
|
kfree(adapter->config_space);
|
||
|
adapter->config_space = NULL;
|
||
|
#endif
|
||
|
}
|
||
|
}
|
||
|
#endif /* !(RHEL_RELEASE_CODE >= RHEL 5.4) */
|
||
|
|
||
|
#ifdef HAVE_PCI_ERS
|
||
|
void _kc_free_netdev(struct net_device *netdev)
|
||
|
{
|
||
|
struct adapter_struct *adapter = netdev_priv(netdev);
|
||
|
|
||
|
kfree(adapter->config_space);
|
||
|
#ifdef CONFIG_SYSFS
|
||
|
if (netdev->reg_state == NETREG_UNINITIALIZED) {
|
||
|
kfree((char *)netdev - netdev->padded);
|
||
|
} else {
|
||
|
BUG_ON(netdev->reg_state != NETREG_UNREGISTERED);
|
||
|
netdev->reg_state = NETREG_RELEASED;
|
||
|
class_device_put(&netdev->class_dev);
|
||
|
}
|
||
|
#else
|
||
|
kfree((char *)netdev - netdev->padded);
|
||
|
#endif
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
void *_kc_kmemdup(const void *src, size_t len, unsigned gfp)
|
||
|
{
|
||
|
void *p;
|
||
|
|
||
|
p = kzalloc(len, gfp);
|
||
|
if (p)
|
||
|
memcpy(p, src, len);
|
||
|
return p;
|
||
|
}
|
||
|
#endif /* <= 2.6.19 */
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21) )
|
||
|
struct pci_dev *_kc_netdev_to_pdev(struct net_device *netdev)
|
||
|
{
|
||
|
return ((struct adapter_struct *)netdev_priv(netdev))->pdev;
|
||
|
}
|
||
|
#endif /* < 2.6.21 */
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,6,22) )
|
||
|
/* hexdump code taken from lib/hexdump.c */
|
||
|
static void _kc_hex_dump_to_buffer(const void *buf, size_t len, int rowsize,
|
||
|
int groupsize, unsigned char *linebuf,
|
||
|
size_t linebuflen, bool ascii)
|
||
|
{
|
||
|
const u8 *ptr = buf;
|
||
|
u8 ch;
|
||
|
int j, lx = 0;
|
||
|
int ascii_column;
|
||
|
|
||
|
if (rowsize != 16 && rowsize != 32)
|
||
|
rowsize = 16;
|
||
|
|
||
|
if (!len)
|
||
|
goto nil;
|
||
|
if (len > rowsize) /* limit to one line at a time */
|
||
|
len = rowsize;
|
||
|
if ((len % groupsize) != 0) /* no mixed size output */
|
||
|
groupsize = 1;
|
||
|
|
||
|
switch (groupsize) {
|
||
|
case 8: {
|
||
|
const u64 *ptr8 = buf;
|
||
|
int ngroups = len / groupsize;
|
||
|
|
||
|
for (j = 0; j < ngroups; j++)
|
||
|
lx += scnprintf((char *)(linebuf + lx), linebuflen - lx,
|
||
|
"%s%16.16llx", j ? " " : "",
|
||
|
(unsigned long long)*(ptr8 + j));
|
||
|
ascii_column = 17 * ngroups + 2;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
case 4: {
|
||
|
const u32 *ptr4 = buf;
|
||
|
int ngroups = len / groupsize;
|
||
|
|
||
|
for (j = 0; j < ngroups; j++)
|
||
|
lx += scnprintf((char *)(linebuf + lx), linebuflen - lx,
|
||
|
"%s%8.8x", j ? " " : "", *(ptr4 + j));
|
||
|
ascii_column = 9 * ngroups + 2;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
case 2: {
|
||
|
const u16 *ptr2 = buf;
|
||
|
int ngroups = len / groupsize;
|
||
|
|
||
|
for (j = 0; j < ngroups; j++)
|
||
|
lx += scnprintf((char *)(linebuf + lx), linebuflen - lx,
|
||
|
"%s%4.4x", j ? " " : "", *(ptr2 + j));
|
||
|
ascii_column = 5 * ngroups + 2;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
default:
|
||
|
for (j = 0; (j < len) && (lx + 3) <= linebuflen; j++) {
|
||
|
ch = ptr[j];
|
||
|
linebuf[lx++] = hex_asc(ch >> 4);
|
||
|
linebuf[lx++] = hex_asc(ch & 0x0f);
|
||
|
linebuf[lx++] = ' ';
|
||
|
}
|
||
|
if (j)
|
||
|
lx--;
|
||
|
|
||
|
ascii_column = 3 * rowsize + 2;
|
||
|
break;
|
||
|
}
|
||
|
if (!ascii)
|
||
|
goto nil;
|
||
|
|
||
|
while (lx < (linebuflen - 1) && lx < (ascii_column - 1))
|
||
|
linebuf[lx++] = ' ';
|
||
|
for (j = 0; (j < len) && (lx + 2) < linebuflen; j++)
|
||
|
linebuf[lx++] = (isascii(ptr[j]) && isprint(ptr[j])) ? ptr[j]
|
||
|
: '.';
|
||
|
nil:
|
||
|
linebuf[lx++] = '\0';
|
||
|
}
|
||
|
|
||
|
void _kc_print_hex_dump(const char *level,
|
||
|
const char *prefix_str, int prefix_type,
|
||
|
int rowsize, int groupsize,
|
||
|
const void *buf, size_t len, bool ascii)
|
||
|
{
|
||
|
const u8 *ptr = buf;
|
||
|
int i, linelen, remaining = len;
|
||
|
unsigned char linebuf[200];
|
||
|
|
||
|
if (rowsize != 16 && rowsize != 32)
|
||
|
rowsize = 16;
|
||
|
|
||
|
for (i = 0; i < len; i += rowsize) {
|
||
|
linelen = min(remaining, rowsize);
|
||
|
remaining -= rowsize;
|
||
|
_kc_hex_dump_to_buffer(ptr + i, linelen, rowsize, groupsize,
|
||
|
linebuf, sizeof(linebuf), ascii);
|
||
|
|
||
|
switch (prefix_type) {
|
||
|
case DUMP_PREFIX_ADDRESS:
|
||
|
printk("%s%s%*p: %s\n", level, prefix_str,
|
||
|
(int)(2 * sizeof(void *)), ptr + i, linebuf);
|
||
|
break;
|
||
|
case DUMP_PREFIX_OFFSET:
|
||
|
printk("%s%s%.8x: %s\n", level, prefix_str, i, linebuf);
|
||
|
break;
|
||
|
default:
|
||
|
printk("%s%s%s\n", level, prefix_str, linebuf);
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
#endif /* < 2.6.22 */
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24) )
|
||
|
#ifdef NAPI
|
||
|
|
||
|
int __kc_adapter_clean(struct net_device *netdev, int *budget)
|
||
|
{
|
||
|
int work_done;
|
||
|
int work_to_do = min(*budget, netdev->quota);
|
||
|
struct adapter_struct *adapter = netdev_priv(netdev);
|
||
|
struct napi_struct *napi = &adapter->rx_ring[0].napi;
|
||
|
work_done = napi->poll(napi, work_to_do);
|
||
|
*budget -= work_done;
|
||
|
netdev->quota -= work_done;
|
||
|
return (work_done >= work_to_do) ? 1 : 0;
|
||
|
}
|
||
|
#endif /* NAPI */
|
||
|
#endif /* <= 2.6.24 */
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,6,26) )
|
||
|
void _kc_pci_disable_link_state(struct pci_dev *pdev, int state)
|
||
|
{
|
||
|
struct pci_dev *parent = pdev->bus->self;
|
||
|
u16 link_state;
|
||
|
int pos;
|
||
|
|
||
|
if (!parent)
|
||
|
return;
|
||
|
|
||
|
pos = pci_find_capability(parent, PCI_CAP_ID_EXP);
|
||
|
if (pos) {
|
||
|
pci_read_config_word(parent, pos + PCI_EXP_LNKCTL, &link_state);
|
||
|
link_state &= ~state;
|
||
|
pci_write_config_word(parent, pos + PCI_EXP_LNKCTL, link_state);
|
||
|
}
|
||
|
}
|
||
|
#endif /* < 2.6.26 */
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,6,27) )
|
||
|
#ifdef HAVE_TX_MQ
|
||
|
void _kc_netif_tx_stop_all_queues(struct net_device *netdev)
|
||
|
{
|
||
|
struct adapter_struct *adapter = netdev_priv(netdev);
|
||
|
int i;
|
||
|
|
||
|
netif_stop_queue(netdev);
|
||
|
if (netif_is_multiqueue(netdev))
|
||
|
for (i = 0; i < adapter->num_tx_queues; i++)
|
||
|
netif_stop_subqueue(netdev, i);
|
||
|
}
|
||
|
void _kc_netif_tx_wake_all_queues(struct net_device *netdev)
|
||
|
{
|
||
|
struct adapter_struct *adapter = netdev_priv(netdev);
|
||
|
int i;
|
||
|
|
||
|
netif_wake_queue(netdev);
|
||
|
if (netif_is_multiqueue(netdev))
|
||
|
for (i = 0; i < adapter->num_tx_queues; i++)
|
||
|
netif_wake_subqueue(netdev, i);
|
||
|
}
|
||
|
void _kc_netif_tx_start_all_queues(struct net_device *netdev)
|
||
|
{
|
||
|
struct adapter_struct *adapter = netdev_priv(netdev);
|
||
|
int i;
|
||
|
|
||
|
netif_start_queue(netdev);
|
||
|
if (netif_is_multiqueue(netdev))
|
||
|
for (i = 0; i < adapter->num_tx_queues; i++)
|
||
|
netif_start_subqueue(netdev, i);
|
||
|
}
|
||
|
#endif /* HAVE_TX_MQ */
|
||
|
|
||
|
void __kc_warn_slowpath(const char *file, int line, const char *fmt, ...)
|
||
|
{
|
||
|
va_list args;
|
||
|
|
||
|
printk(KERN_WARNING "------------[ cut here ]------------\n");
|
||
|
printk(KERN_WARNING "WARNING: at %s:%d \n", file, line);
|
||
|
va_start(args, fmt);
|
||
|
vprintk(fmt, args);
|
||
|
va_end(args);
|
||
|
|
||
|
dump_stack();
|
||
|
}
|
||
|
#endif /* __VMKLNX__ */
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,6,28) )
|
||
|
|
||
|
int
|
||
|
_kc_pci_prepare_to_sleep(struct pci_dev *dev)
|
||
|
{
|
||
|
pci_power_t target_state;
|
||
|
int error;
|
||
|
|
||
|
target_state = pci_choose_state(dev, PMSG_SUSPEND);
|
||
|
|
||
|
pci_enable_wake(dev, target_state, true);
|
||
|
|
||
|
error = pci_set_power_state(dev, target_state);
|
||
|
|
||
|
if (error)
|
||
|
pci_enable_wake(dev, target_state, false);
|
||
|
|
||
|
return error;
|
||
|
}
|
||
|
|
||
|
int
|
||
|
_kc_pci_wake_from_d3(struct pci_dev *dev, bool enable)
|
||
|
{
|
||
|
int err;
|
||
|
|
||
|
err = pci_enable_wake(dev, PCI_D3cold, enable);
|
||
|
if (err)
|
||
|
goto out;
|
||
|
|
||
|
err = pci_enable_wake(dev, PCI_D3hot, enable);
|
||
|
|
||
|
out:
|
||
|
return err;
|
||
|
}
|
||
|
#endif /* < 2.6.28 */
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,6,29) )
|
||
|
static void __kc_pci_set_master(struct pci_dev *pdev, bool enable)
|
||
|
{
|
||
|
u16 old_cmd, cmd;
|
||
|
|
||
|
pci_read_config_word(pdev, PCI_COMMAND, &old_cmd);
|
||
|
if (enable)
|
||
|
cmd = old_cmd | PCI_COMMAND_MASTER;
|
||
|
else
|
||
|
cmd = old_cmd & ~PCI_COMMAND_MASTER;
|
||
|
if (cmd != old_cmd) {
|
||
|
dev_dbg(pci_dev_to_dev(pdev), "%s bus mastering\n",
|
||
|
enable ? "enabling" : "disabling");
|
||
|
pci_write_config_word(pdev, PCI_COMMAND, cmd);
|
||
|
}
|
||
|
#if ( LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,7) )
|
||
|
pdev->is_busmaster = enable;
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
void _kc_pci_clear_master(struct pci_dev *dev)
|
||
|
{
|
||
|
__kc_pci_set_master(dev, false);
|
||
|
}
|
||
|
#endif /* < 2.6.29 */
|
||
|
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,6,34) )
|
||
|
#if (RHEL_RELEASE_CODE < RHEL_RELEASE_VERSION(6,0))
|
||
|
int _kc_pci_num_vf(struct pci_dev __maybe_unused *dev)
|
||
|
{
|
||
|
int num_vf = 0;
|
||
|
#ifdef CONFIG_PCI_IOV
|
||
|
struct pci_dev *vfdev;
|
||
|
|
||
|
/* loop through all ethernet devices starting at PF dev */
|
||
|
vfdev = pci_get_class(PCI_CLASS_NETWORK_ETHERNET << 8, NULL);
|
||
|
while (vfdev) {
|
||
|
if (vfdev->is_virtfn && vfdev->physfn == dev)
|
||
|
num_vf++;
|
||
|
|
||
|
vfdev = pci_get_class(PCI_CLASS_NETWORK_ETHERNET << 8, vfdev);
|
||
|
}
|
||
|
|
||
|
#endif
|
||
|
return num_vf;
|
||
|
}
|
||
|
#endif /* RHEL_RELEASE_CODE */
|
||
|
#endif /* < 2.6.34 */
|
||
|
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,6,35) )
|
||
|
#endif /* < 2.6.35 */
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,6,36) )
|
||
|
static const u32 _kc_flags_dup_features =
|
||
|
(ETH_FLAG_LRO | ETH_FLAG_NTUPLE | ETH_FLAG_RXHASH);
|
||
|
|
||
|
u32 _kc_ethtool_op_get_flags(struct net_device *dev)
|
||
|
{
|
||
|
return dev->features & _kc_flags_dup_features;
|
||
|
}
|
||
|
|
||
|
int _kc_ethtool_op_set_flags(struct net_device *dev, u32 data, u32 supported)
|
||
|
{
|
||
|
if (data & ~supported)
|
||
|
return -EINVAL;
|
||
|
|
||
|
dev->features = ((dev->features & ~_kc_flags_dup_features) |
|
||
|
(data & _kc_flags_dup_features));
|
||
|
return 0;
|
||
|
}
|
||
|
#endif /* < 2.6.36 */
|
||
|
|
||
|
/******************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,6,39) )
|
||
|
#if (!(RHEL_RELEASE_CODE && RHEL_RELEASE_CODE > RHEL_RELEASE_VERSION(6,0)))
|
||
|
|
||
|
#endif /* !(RHEL_RELEASE_CODE > RHEL_RELEASE_VERSION(6,0)) */
|
||
|
#endif /* < 2.6.39 */
|
||
|
|
||
|
/******************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(3,4,0) )
|
||
|
void _kc_skb_add_rx_frag(struct sk_buff *skb, int i, struct page *page,
|
||
|
int off, int size, unsigned int truesize)
|
||
|
{
|
||
|
skb_fill_page_desc(skb, i, page, off, size);
|
||
|
skb->len += size;
|
||
|
skb->data_len += size;
|
||
|
skb->truesize += truesize;
|
||
|
}
|
||
|
|
||
|
#if !(SLE_VERSION_CODE && SLE_VERSION_CODE >= SLE_VERSION(11,3,0))
|
||
|
int _kc_simple_open(struct inode *inode, struct file *file)
|
||
|
{
|
||
|
if (inode->i_private)
|
||
|
file->private_data = inode->i_private;
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
#endif /* SLE_VERSION < 11,3,0 */
|
||
|
|
||
|
#endif /* < 3.4.0 */
|
||
|
|
||
|
/******************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(3,7,0) )
|
||
|
static inline int __kc_pcie_cap_version(struct pci_dev *dev)
|
||
|
{
|
||
|
int pos;
|
||
|
u16 reg16;
|
||
|
|
||
|
pos = pci_find_capability(dev, PCI_CAP_ID_EXP);
|
||
|
if (!pos)
|
||
|
return 0;
|
||
|
pci_read_config_word(dev, pos + PCI_EXP_FLAGS, ®16);
|
||
|
return reg16 & PCI_EXP_FLAGS_VERS;
|
||
|
}
|
||
|
|
||
|
static inline bool __kc_pcie_cap_has_devctl(const struct pci_dev __always_unused *dev)
|
||
|
{
|
||
|
return true;
|
||
|
}
|
||
|
|
||
|
static inline bool __kc_pcie_cap_has_lnkctl(struct pci_dev *dev)
|
||
|
{
|
||
|
int type = pci_pcie_type(dev);
|
||
|
|
||
|
return __kc_pcie_cap_version(dev) > 1 ||
|
||
|
type == PCI_EXP_TYPE_ROOT_PORT ||
|
||
|
type == PCI_EXP_TYPE_ENDPOINT ||
|
||
|
type == PCI_EXP_TYPE_LEG_END;
|
||
|
}
|
||
|
|
||
|
static inline bool __kc_pcie_cap_has_sltctl(struct pci_dev *dev)
|
||
|
{
|
||
|
int type = pci_pcie_type(dev);
|
||
|
int pos;
|
||
|
u16 pcie_flags_reg;
|
||
|
|
||
|
pos = pci_find_capability(dev, PCI_CAP_ID_EXP);
|
||
|
if (!pos)
|
||
|
return false;
|
||
|
pci_read_config_word(dev, pos + PCI_EXP_FLAGS, &pcie_flags_reg);
|
||
|
|
||
|
return __kc_pcie_cap_version(dev) > 1 ||
|
||
|
type == PCI_EXP_TYPE_ROOT_PORT ||
|
||
|
(type == PCI_EXP_TYPE_DOWNSTREAM &&
|
||
|
pcie_flags_reg & PCI_EXP_FLAGS_SLOT);
|
||
|
}
|
||
|
|
||
|
static inline bool __kc_pcie_cap_has_rtctl(struct pci_dev *dev)
|
||
|
{
|
||
|
int type = pci_pcie_type(dev);
|
||
|
|
||
|
return __kc_pcie_cap_version(dev) > 1 ||
|
||
|
type == PCI_EXP_TYPE_ROOT_PORT ||
|
||
|
type == PCI_EXP_TYPE_RC_EC;
|
||
|
}
|
||
|
|
||
|
static bool __kc_pcie_capability_reg_implemented(struct pci_dev *dev, int pos)
|
||
|
{
|
||
|
if (!pci_is_pcie(dev))
|
||
|
return false;
|
||
|
|
||
|
switch (pos) {
|
||
|
case PCI_EXP_FLAGS_TYPE:
|
||
|
return true;
|
||
|
case PCI_EXP_DEVCAP:
|
||
|
case PCI_EXP_DEVCTL:
|
||
|
case PCI_EXP_DEVSTA:
|
||
|
return __kc_pcie_cap_has_devctl(dev);
|
||
|
case PCI_EXP_LNKCAP:
|
||
|
case PCI_EXP_LNKCTL:
|
||
|
case PCI_EXP_LNKSTA:
|
||
|
return __kc_pcie_cap_has_lnkctl(dev);
|
||
|
case PCI_EXP_SLTCAP:
|
||
|
case PCI_EXP_SLTCTL:
|
||
|
case PCI_EXP_SLTSTA:
|
||
|
return __kc_pcie_cap_has_sltctl(dev);
|
||
|
case PCI_EXP_RTCTL:
|
||
|
case PCI_EXP_RTCAP:
|
||
|
case PCI_EXP_RTSTA:
|
||
|
return __kc_pcie_cap_has_rtctl(dev);
|
||
|
case PCI_EXP_DEVCAP2:
|
||
|
case PCI_EXP_DEVCTL2:
|
||
|
case PCI_EXP_LNKCAP2:
|
||
|
case PCI_EXP_LNKCTL2:
|
||
|
case PCI_EXP_LNKSTA2:
|
||
|
return __kc_pcie_cap_version(dev) > 1;
|
||
|
default:
|
||
|
return false;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* Note that these accessor functions are only for the "PCI Express
|
||
|
* Capability" (see PCIe spec r3.0, sec 7.8). They do not apply to the
|
||
|
* other "PCI Express Extended Capabilities" (AER, VC, ACS, MFVC, etc.)
|
||
|
*/
|
||
|
int __kc_pcie_capability_read_word(struct pci_dev *dev, int pos, u16 *val)
|
||
|
{
|
||
|
int ret;
|
||
|
|
||
|
*val = 0;
|
||
|
if (pos & 1)
|
||
|
return -EINVAL;
|
||
|
|
||
|
if (__kc_pcie_capability_reg_implemented(dev, pos)) {
|
||
|
ret = pci_read_config_word(dev, pci_pcie_cap(dev) + pos, val);
|
||
|
/*
|
||
|
* Reset *val to 0 if pci_read_config_word() fails, it may
|
||
|
* have been written as 0xFFFF if hardware error happens
|
||
|
* during pci_read_config_word().
|
||
|
*/
|
||
|
if (ret)
|
||
|
*val = 0;
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* For Functions that do not implement the Slot Capabilities,
|
||
|
* Slot Status, and Slot Control registers, these spaces must
|
||
|
* be hardwired to 0b, with the exception of the Presence Detect
|
||
|
* State bit in the Slot Status register of Downstream Ports,
|
||
|
* which must be hardwired to 1b. (PCIe Base Spec 3.0, sec 7.8)
|
||
|
*/
|
||
|
if (pci_is_pcie(dev) && pos == PCI_EXP_SLTSTA &&
|
||
|
pci_pcie_type(dev) == PCI_EXP_TYPE_DOWNSTREAM) {
|
||
|
*val = PCI_EXP_SLTSTA_PDS;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
int __kc_pcie_capability_read_dword(struct pci_dev *dev, int pos, u32 *val)
|
||
|
{
|
||
|
int ret;
|
||
|
|
||
|
*val = 0;
|
||
|
if (pos & 3)
|
||
|
return -EINVAL;
|
||
|
|
||
|
if (__kc_pcie_capability_reg_implemented(dev, pos)) {
|
||
|
ret = pci_read_config_dword(dev, pci_pcie_cap(dev) + pos, val);
|
||
|
/*
|
||
|
* Reset *val to 0 if pci_read_config_dword() fails, it may
|
||
|
* have been written as 0xFFFFFFFF if hardware error happens
|
||
|
* during pci_read_config_dword().
|
||
|
*/
|
||
|
if (ret)
|
||
|
*val = 0;
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
if (pci_is_pcie(dev) && pos == PCI_EXP_SLTSTA &&
|
||
|
pci_pcie_type(dev) == PCI_EXP_TYPE_DOWNSTREAM) {
|
||
|
*val = PCI_EXP_SLTSTA_PDS;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
int __kc_pcie_capability_write_word(struct pci_dev *dev, int pos, u16 val)
|
||
|
{
|
||
|
if (pos & 1)
|
||
|
return -EINVAL;
|
||
|
|
||
|
if (!__kc_pcie_capability_reg_implemented(dev, pos))
|
||
|
return 0;
|
||
|
|
||
|
return pci_write_config_word(dev, pci_pcie_cap(dev) + pos, val);
|
||
|
}
|
||
|
|
||
|
int __kc_pcie_capability_clear_and_set_word(struct pci_dev *dev, int pos,
|
||
|
u16 clear, u16 set)
|
||
|
{
|
||
|
int ret;
|
||
|
u16 val;
|
||
|
|
||
|
ret = __kc_pcie_capability_read_word(dev, pos, &val);
|
||
|
if (!ret) {
|
||
|
val &= ~clear;
|
||
|
val |= set;
|
||
|
ret = __kc_pcie_capability_write_word(dev, pos, val);
|
||
|
}
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
int __kc_pcie_capability_clear_word(struct pci_dev *dev, int pos,
|
||
|
u16 clear)
|
||
|
{
|
||
|
return __kc_pcie_capability_clear_and_set_word(dev, pos, clear, 0);
|
||
|
}
|
||
|
#endif /* < 3.7.0 */
|
||
|
|
||
|
/******************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(3,9,0) )
|
||
|
#endif /* 3.9.0 */
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(3,10,0) )
|
||
|
#ifdef HAVE_FDB_OPS
|
||
|
#ifdef USE_CONST_DEV_UC_CHAR
|
||
|
int __kc_ndo_dflt_fdb_add(struct ndmsg *ndm, struct nlattr *tb[],
|
||
|
struct net_device *dev, const unsigned char *addr,
|
||
|
u16 flags)
|
||
|
#else
|
||
|
int __kc_ndo_dflt_fdb_add(struct ndmsg *ndm, struct net_device *dev,
|
||
|
unsigned char *addr, u16 flags)
|
||
|
#endif
|
||
|
{
|
||
|
int err = -EINVAL;
|
||
|
|
||
|
/* If aging addresses are supported device will need to
|
||
|
* implement its own handler for this.
|
||
|
*/
|
||
|
if (ndm->ndm_state && !(ndm->ndm_state & NUD_PERMANENT)) {
|
||
|
pr_info("%s: FDB only supports static addresses\n", dev->name);
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
if (is_unicast_ether_addr(addr) || is_link_local_ether_addr(addr))
|
||
|
err = dev_uc_add_excl(dev, addr);
|
||
|
else if (is_multicast_ether_addr(addr))
|
||
|
err = dev_mc_add_excl(dev, addr);
|
||
|
|
||
|
/* Only return duplicate errors if NLM_F_EXCL is set */
|
||
|
if (err == -EEXIST && !(flags & NLM_F_EXCL))
|
||
|
err = 0;
|
||
|
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
#ifdef USE_CONST_DEV_UC_CHAR
|
||
|
#ifdef HAVE_FDB_DEL_NLATTR
|
||
|
int __kc_ndo_dflt_fdb_del(struct ndmsg *ndm, struct nlattr *tb[],
|
||
|
struct net_device *dev, const unsigned char *addr)
|
||
|
#else
|
||
|
int __kc_ndo_dflt_fdb_del(struct ndmsg *ndm, struct net_device *dev,
|
||
|
const unsigned char *addr)
|
||
|
#endif
|
||
|
#else
|
||
|
int __kc_ndo_dflt_fdb_del(struct ndmsg *ndm, struct net_device *dev,
|
||
|
unsigned char *addr)
|
||
|
#endif
|
||
|
{
|
||
|
int err = -EINVAL;
|
||
|
|
||
|
/* If aging addresses are supported device will need to
|
||
|
* implement its own handler for this.
|
||
|
*/
|
||
|
if (!(ndm->ndm_state & NUD_PERMANENT)) {
|
||
|
pr_info("%s: FDB only supports static addresses\n", dev->name);
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
if (is_unicast_ether_addr(addr) || is_link_local_ether_addr(addr))
|
||
|
err = dev_uc_del(dev, addr);
|
||
|
else if (is_multicast_ether_addr(addr))
|
||
|
err = dev_mc_del(dev, addr);
|
||
|
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
#endif /* HAVE_FDB_OPS */
|
||
|
#ifdef CONFIG_PCI_IOV
|
||
|
int __kc_pci_vfs_assigned(struct pci_dev __maybe_unused *dev)
|
||
|
{
|
||
|
unsigned int vfs_assigned = 0;
|
||
|
#ifdef HAVE_PCI_DEV_FLAGS_ASSIGNED
|
||
|
int pos;
|
||
|
struct pci_dev *vfdev;
|
||
|
unsigned short dev_id;
|
||
|
|
||
|
/* only search if we are a PF */
|
||
|
if (!dev->is_physfn)
|
||
|
return 0;
|
||
|
|
||
|
/* find SR-IOV capability */
|
||
|
pos = pci_find_ext_capability(dev, PCI_EXT_CAP_ID_SRIOV);
|
||
|
if (!pos)
|
||
|
return 0;
|
||
|
|
||
|
/*
|
||
|
* determine the device ID for the VFs, the vendor ID will be the
|
||
|
* same as the PF so there is no need to check for that one
|
||
|
*/
|
||
|
pci_read_config_word(dev, pos + PCI_SRIOV_VF_DID, &dev_id);
|
||
|
|
||
|
/* loop through all the VFs to see if we own any that are assigned */
|
||
|
vfdev = pci_get_device(dev->vendor, dev_id, NULL);
|
||
|
while (vfdev) {
|
||
|
/*
|
||
|
* It is considered assigned if it is a virtual function with
|
||
|
* our dev as the physical function and the assigned bit is set
|
||
|
*/
|
||
|
if (vfdev->is_virtfn && (vfdev->physfn == dev) &&
|
||
|
(vfdev->dev_flags & PCI_DEV_FLAGS_ASSIGNED))
|
||
|
vfs_assigned++;
|
||
|
|
||
|
vfdev = pci_get_device(dev->vendor, dev_id, vfdev);
|
||
|
}
|
||
|
|
||
|
#endif /* HAVE_PCI_DEV_FLAGS_ASSIGNED */
|
||
|
return vfs_assigned;
|
||
|
}
|
||
|
|
||
|
#endif /* CONFIG_PCI_IOV */
|
||
|
#endif /* 3.10.0 */
|
||
|
|
||
|
static const unsigned char __maybe_unused pcie_link_speed[] = {
|
||
|
PCI_SPEED_UNKNOWN, /* 0 */
|
||
|
PCIE_SPEED_2_5GT, /* 1 */
|
||
|
PCIE_SPEED_5_0GT, /* 2 */
|
||
|
PCIE_SPEED_8_0GT, /* 3 */
|
||
|
PCIE_SPEED_16_0GT, /* 4 */
|
||
|
PCI_SPEED_UNKNOWN, /* 5 */
|
||
|
PCI_SPEED_UNKNOWN, /* 6 */
|
||
|
PCI_SPEED_UNKNOWN, /* 7 */
|
||
|
PCI_SPEED_UNKNOWN, /* 8 */
|
||
|
PCI_SPEED_UNKNOWN, /* 9 */
|
||
|
PCI_SPEED_UNKNOWN, /* A */
|
||
|
PCI_SPEED_UNKNOWN, /* B */
|
||
|
PCI_SPEED_UNKNOWN, /* C */
|
||
|
PCI_SPEED_UNKNOWN, /* D */
|
||
|
PCI_SPEED_UNKNOWN, /* E */
|
||
|
PCI_SPEED_UNKNOWN /* F */
|
||
|
};
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(3,12,0) )
|
||
|
int __kc_pcie_get_minimum_link(struct pci_dev *dev, enum pci_bus_speed *speed,
|
||
|
enum pcie_link_width *width)
|
||
|
{
|
||
|
|
||
|
*speed = PCI_SPEED_UNKNOWN;
|
||
|
*width = PCIE_LNK_WIDTH_UNKNOWN;
|
||
|
|
||
|
while (dev) {
|
||
|
u16 lnksta;
|
||
|
enum pci_bus_speed next_speed;
|
||
|
enum pcie_link_width next_width;
|
||
|
int ret = pcie_capability_read_word(dev, PCI_EXP_LNKSTA, &lnksta);
|
||
|
|
||
|
if (ret)
|
||
|
return ret;
|
||
|
|
||
|
next_speed = pcie_link_speed[lnksta & PCI_EXP_LNKSTA_CLS];
|
||
|
next_width = (lnksta & PCI_EXP_LNKSTA_NLW) >>
|
||
|
PCI_EXP_LNKSTA_NLW_SHIFT;
|
||
|
|
||
|
if (next_speed < *speed)
|
||
|
*speed = next_speed;
|
||
|
|
||
|
if (next_width < *width)
|
||
|
*width = next_width;
|
||
|
|
||
|
dev = dev->bus->self;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
#if (RHEL_RELEASE_CODE < RHEL_RELEASE_VERSION(6,7))
|
||
|
int _kc_pci_wait_for_pending_transaction(struct pci_dev *dev)
|
||
|
{
|
||
|
int i;
|
||
|
u16 status;
|
||
|
|
||
|
/* Wait for Transaction Pending bit clean */
|
||
|
for (i = 0; i < 4; i++) {
|
||
|
if (i)
|
||
|
msleep((1 << (i - 1)) * 100);
|
||
|
|
||
|
pcie_capability_read_word(dev, PCI_EXP_DEVSTA, &status);
|
||
|
if (!(status & PCI_EXP_DEVSTA_TRPND))
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
#endif /* <RHEL6.7 */
|
||
|
|
||
|
#endif /* <3.12 */
|
||
|
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(3,13,0) )
|
||
|
int __kc_dma_set_mask_and_coherent(struct device *dev, u64 mask)
|
||
|
{
|
||
|
int err = dma_set_mask(dev, mask);
|
||
|
|
||
|
if (!err)
|
||
|
/* coherent mask for the same size will always succeed if
|
||
|
* dma_set_mask does. However we store the error anyways, due
|
||
|
* to some kernels which use gcc's warn_unused_result on their
|
||
|
* definition of dma_set_coherent_mask.
|
||
|
*/
|
||
|
err = dma_set_coherent_mask(dev, mask);
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
#if (RHEL_RELEASE_CODE < RHEL_RELEASE_VERSION(7,0))
|
||
|
static bool _kc_pci_bus_read_dev_vendor_id(struct pci_bus *bus, int devfn,
|
||
|
u32 *l, int crs_timeout)
|
||
|
{
|
||
|
int delay = 1;
|
||
|
|
||
|
if (pci_bus_read_config_dword(bus, devfn, PCI_VENDOR_ID, l))
|
||
|
return false;
|
||
|
|
||
|
/* some broken boards return 0 or ~0 if a slot is empty: */
|
||
|
if (*l == 0xffffffff || *l == 0x00000000 ||
|
||
|
*l == 0x0000ffff || *l == 0xffff0000)
|
||
|
return false;
|
||
|
|
||
|
/* Configuration request Retry Status */
|
||
|
while (*l == 0xffff0001) {
|
||
|
if (!crs_timeout)
|
||
|
return false;
|
||
|
|
||
|
msleep(delay);
|
||
|
delay *= 2;
|
||
|
if (pci_bus_read_config_dword(bus, devfn, PCI_VENDOR_ID, l))
|
||
|
return false;
|
||
|
/* Card hasn't responded in 60 seconds? Must be stuck. */
|
||
|
if (delay > crs_timeout) {
|
||
|
printk(KERN_WARNING "pci %04x:%02x:%02x.%d: not "
|
||
|
"responding\n", pci_domain_nr(bus),
|
||
|
bus->number, PCI_SLOT(devfn),
|
||
|
PCI_FUNC(devfn));
|
||
|
return false;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return true;
|
||
|
}
|
||
|
|
||
|
bool _kc_pci_device_is_present(struct pci_dev *pdev)
|
||
|
{
|
||
|
u32 v;
|
||
|
|
||
|
return _kc_pci_bus_read_dev_vendor_id(pdev->bus, pdev->devfn, &v, 0);
|
||
|
}
|
||
|
#endif /* <RHEL7.0 */
|
||
|
#endif /* 3.13.0 */
|
||
|
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(3,14,0) )
|
||
|
/******************************************************************************
|
||
|
* ripped from linux/net/ipv6/exthdrs_core.c, GPL2, no direct copyright,
|
||
|
* inferred copyright from kernel
|
||
|
*/
|
||
|
int __kc_ipv6_find_hdr(const struct sk_buff *skb, unsigned int *offset,
|
||
|
int target, unsigned short *fragoff, int *flags)
|
||
|
{
|
||
|
unsigned int start = skb_network_offset(skb) + sizeof(struct ipv6hdr);
|
||
|
u8 nexthdr = ipv6_hdr(skb)->nexthdr;
|
||
|
bool found;
|
||
|
|
||
|
#define __KC_IP6_FH_F_FRAG BIT(0)
|
||
|
#define __KC_IP6_FH_F_AUTH BIT(1)
|
||
|
#define __KC_IP6_FH_F_SKIP_RH BIT(2)
|
||
|
|
||
|
if (fragoff)
|
||
|
*fragoff = 0;
|
||
|
|
||
|
if (*offset) {
|
||
|
struct ipv6hdr _ip6, *ip6;
|
||
|
|
||
|
ip6 = skb_header_pointer(skb, *offset, sizeof(_ip6), &_ip6);
|
||
|
if (!ip6 || (ip6->version != 6)) {
|
||
|
printk(KERN_ERR "IPv6 header not found\n");
|
||
|
return -EBADMSG;
|
||
|
}
|
||
|
start = *offset + sizeof(struct ipv6hdr);
|
||
|
nexthdr = ip6->nexthdr;
|
||
|
}
|
||
|
|
||
|
do {
|
||
|
struct ipv6_opt_hdr _hdr, *hp;
|
||
|
unsigned int hdrlen;
|
||
|
found = (nexthdr == target);
|
||
|
|
||
|
if ((!ipv6_ext_hdr(nexthdr)) || nexthdr == NEXTHDR_NONE) {
|
||
|
if (target < 0 || found)
|
||
|
break;
|
||
|
return -ENOENT;
|
||
|
}
|
||
|
|
||
|
hp = skb_header_pointer(skb, start, sizeof(_hdr), &_hdr);
|
||
|
if (!hp)
|
||
|
return -EBADMSG;
|
||
|
|
||
|
if (nexthdr == NEXTHDR_ROUTING) {
|
||
|
struct ipv6_rt_hdr _rh, *rh;
|
||
|
|
||
|
rh = skb_header_pointer(skb, start, sizeof(_rh),
|
||
|
&_rh);
|
||
|
if (!rh)
|
||
|
return -EBADMSG;
|
||
|
|
||
|
if (flags && (*flags & __KC_IP6_FH_F_SKIP_RH) &&
|
||
|
rh->segments_left == 0)
|
||
|
found = false;
|
||
|
}
|
||
|
|
||
|
if (nexthdr == NEXTHDR_FRAGMENT) {
|
||
|
unsigned short _frag_off;
|
||
|
__be16 *fp;
|
||
|
|
||
|
if (flags) /* Indicate that this is a fragment */
|
||
|
*flags |= __KC_IP6_FH_F_FRAG;
|
||
|
fp = skb_header_pointer(skb,
|
||
|
start+offsetof(struct frag_hdr,
|
||
|
frag_off),
|
||
|
sizeof(_frag_off),
|
||
|
&_frag_off);
|
||
|
if (!fp)
|
||
|
return -EBADMSG;
|
||
|
|
||
|
_frag_off = ntohs(*fp) & ~0x7;
|
||
|
if (_frag_off) {
|
||
|
if (target < 0 &&
|
||
|
((!ipv6_ext_hdr(hp->nexthdr)) ||
|
||
|
hp->nexthdr == NEXTHDR_NONE)) {
|
||
|
if (fragoff)
|
||
|
*fragoff = _frag_off;
|
||
|
return hp->nexthdr;
|
||
|
}
|
||
|
return -ENOENT;
|
||
|
}
|
||
|
hdrlen = 8;
|
||
|
} else if (nexthdr == NEXTHDR_AUTH) {
|
||
|
if (flags && (*flags & __KC_IP6_FH_F_AUTH) && (target < 0))
|
||
|
break;
|
||
|
hdrlen = (hp->hdrlen + 2) << 2;
|
||
|
} else
|
||
|
hdrlen = ipv6_optlen(hp);
|
||
|
|
||
|
if (!found) {
|
||
|
nexthdr = hp->nexthdr;
|
||
|
start += hdrlen;
|
||
|
}
|
||
|
} while (!found);
|
||
|
|
||
|
*offset = start;
|
||
|
return nexthdr;
|
||
|
}
|
||
|
|
||
|
int __kc_pci_enable_msix_range(struct pci_dev *dev, struct msix_entry *entries,
|
||
|
int minvec, int maxvec)
|
||
|
{
|
||
|
int nvec = maxvec;
|
||
|
int rc;
|
||
|
|
||
|
if (maxvec < minvec)
|
||
|
return -ERANGE;
|
||
|
|
||
|
do {
|
||
|
rc = pci_enable_msix(dev, entries, nvec);
|
||
|
if (rc < 0) {
|
||
|
return rc;
|
||
|
} else if (rc > 0) {
|
||
|
if (rc < minvec)
|
||
|
return -ENOSPC;
|
||
|
nvec = rc;
|
||
|
}
|
||
|
} while (rc);
|
||
|
|
||
|
return nvec;
|
||
|
}
|
||
|
#endif /* 3.14.0 */
|
||
|
|
||
|
#if (LINUX_VERSION_CODE < KERNEL_VERSION(3,15,0))
|
||
|
char *_kc_devm_kstrdup(struct device *dev, const char *s, gfp_t gfp)
|
||
|
{
|
||
|
size_t size;
|
||
|
char *buf;
|
||
|
|
||
|
if (!s)
|
||
|
return NULL;
|
||
|
|
||
|
size = strlen(s) + 1;
|
||
|
buf = devm_kzalloc(dev, size, gfp);
|
||
|
if (buf)
|
||
|
memcpy(buf, s, size);
|
||
|
return buf;
|
||
|
}
|
||
|
|
||
|
void __kc_netdev_rss_key_fill(void *buffer, size_t len)
|
||
|
{
|
||
|
/* Set of random keys generated using kernel random number generator */
|
||
|
static const u8 seed[NETDEV_RSS_KEY_LEN] = {0xE6, 0xFA, 0x35, 0x62,
|
||
|
0x95, 0x12, 0x3E, 0xA3, 0xFB, 0x46, 0xC1, 0x5F,
|
||
|
0xB1, 0x43, 0x82, 0x5B, 0x6A, 0x49, 0x50, 0x95,
|
||
|
0xCD, 0xAB, 0xD8, 0x11, 0x8F, 0xC5, 0xBD, 0xBC,
|
||
|
0x6A, 0x4A, 0xB2, 0xD4, 0x1F, 0xFE, 0xBC, 0x41,
|
||
|
0xBF, 0xAC, 0xB2, 0x9A, 0x8F, 0x70, 0xE9, 0x2A,
|
||
|
0xD7, 0xB2, 0x80, 0xB6, 0x5B, 0xAA, 0x9D, 0x20};
|
||
|
|
||
|
BUG_ON(len > NETDEV_RSS_KEY_LEN);
|
||
|
memcpy(buffer, seed, len);
|
||
|
}
|
||
|
#endif /* 3.15.0 */
|
||
|
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(3,16,0) )
|
||
|
#ifdef HAVE_SET_RX_MODE
|
||
|
#ifdef NETDEV_HW_ADDR_T_UNICAST
|
||
|
int __kc_hw_addr_sync_dev(struct netdev_hw_addr_list *list,
|
||
|
struct net_device *dev,
|
||
|
int (*sync)(struct net_device *, const unsigned char *),
|
||
|
int (*unsync)(struct net_device *, const unsigned char *))
|
||
|
{
|
||
|
struct netdev_hw_addr *ha, *tmp;
|
||
|
int err;
|
||
|
|
||
|
/* first go through and flush out any stale entries */
|
||
|
list_for_each_entry_safe(ha, tmp, &list->list, list) {
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(3,10,0) )
|
||
|
if (!ha->synced || ha->refcount != 1)
|
||
|
#else
|
||
|
if (!ha->sync_cnt || ha->refcount != 1)
|
||
|
#endif
|
||
|
continue;
|
||
|
|
||
|
if (unsync && unsync(dev, ha->addr))
|
||
|
continue;
|
||
|
|
||
|
list_del_rcu(&ha->list);
|
||
|
kfree_rcu(ha, rcu_head);
|
||
|
list->count--;
|
||
|
}
|
||
|
|
||
|
/* go through and sync new entries to the list */
|
||
|
list_for_each_entry_safe(ha, tmp, &list->list, list) {
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(3,10,0) )
|
||
|
if (ha->synced)
|
||
|
#else
|
||
|
if (ha->sync_cnt)
|
||
|
#endif
|
||
|
continue;
|
||
|
|
||
|
err = sync(dev, ha->addr);
|
||
|
if (err)
|
||
|
return err;
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(3,10,0) )
|
||
|
ha->synced = true;
|
||
|
#else
|
||
|
ha->sync_cnt++;
|
||
|
#endif
|
||
|
ha->refcount++;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
void __kc_hw_addr_unsync_dev(struct netdev_hw_addr_list *list,
|
||
|
struct net_device *dev,
|
||
|
int (*unsync)(struct net_device *, const unsigned char *))
|
||
|
{
|
||
|
struct netdev_hw_addr *ha, *tmp;
|
||
|
|
||
|
list_for_each_entry_safe(ha, tmp, &list->list, list) {
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(3,10,0) )
|
||
|
if (!ha->synced)
|
||
|
#else
|
||
|
if (!ha->sync_cnt)
|
||
|
#endif
|
||
|
continue;
|
||
|
|
||
|
if (unsync && unsync(dev, ha->addr))
|
||
|
continue;
|
||
|
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(3,10,0) )
|
||
|
ha->synced = false;
|
||
|
#else
|
||
|
ha->sync_cnt--;
|
||
|
#endif
|
||
|
if (--ha->refcount)
|
||
|
continue;
|
||
|
|
||
|
list_del_rcu(&ha->list);
|
||
|
kfree_rcu(ha, rcu_head);
|
||
|
list->count--;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
#endif /* NETDEV_HW_ADDR_T_UNICAST */
|
||
|
#ifndef NETDEV_HW_ADDR_T_MULTICAST
|
||
|
int __kc_dev_addr_sync_dev(struct dev_addr_list **list, int *count,
|
||
|
struct net_device *dev,
|
||
|
int (*sync)(struct net_device *, const unsigned char *),
|
||
|
int (*unsync)(struct net_device *, const unsigned char *))
|
||
|
{
|
||
|
struct dev_addr_list *da, **next = list;
|
||
|
int err;
|
||
|
|
||
|
/* first go through and flush out any stale entries */
|
||
|
while ((da = *next) != NULL) {
|
||
|
if (da->da_synced && da->da_users == 1) {
|
||
|
if (!unsync || !unsync(dev, da->da_addr)) {
|
||
|
*next = da->next;
|
||
|
kfree(da);
|
||
|
(*count)--;
|
||
|
continue;
|
||
|
}
|
||
|
}
|
||
|
next = &da->next;
|
||
|
}
|
||
|
|
||
|
/* go through and sync new entries to the list */
|
||
|
for (da = *list; da != NULL; da = da->next) {
|
||
|
if (da->da_synced)
|
||
|
continue;
|
||
|
|
||
|
err = sync(dev, da->da_addr);
|
||
|
if (err)
|
||
|
return err;
|
||
|
|
||
|
da->da_synced++;
|
||
|
da->da_users++;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
void __kc_dev_addr_unsync_dev(struct dev_addr_list **list, int *count,
|
||
|
struct net_device *dev,
|
||
|
int (*unsync)(struct net_device *, const unsigned char *))
|
||
|
{
|
||
|
struct dev_addr_list *da;
|
||
|
|
||
|
while ((da = *list) != NULL) {
|
||
|
if (da->da_synced) {
|
||
|
if (!unsync || !unsync(dev, da->da_addr)) {
|
||
|
da->da_synced--;
|
||
|
if (--da->da_users == 0) {
|
||
|
*list = da->next;
|
||
|
kfree(da);
|
||
|
(*count)--;
|
||
|
continue;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
list = &da->next;
|
||
|
}
|
||
|
}
|
||
|
#endif /* NETDEV_HW_ADDR_T_MULTICAST */
|
||
|
#endif /* HAVE_SET_RX_MODE */
|
||
|
void *__kc_devm_kmemdup(struct device *dev, const void *src, size_t len,
|
||
|
gfp_t gfp)
|
||
|
{
|
||
|
void *p;
|
||
|
|
||
|
p = devm_kzalloc(dev, len, gfp);
|
||
|
if (p)
|
||
|
memcpy(p, src, len);
|
||
|
|
||
|
return p;
|
||
|
}
|
||
|
#endif /* 3.16.0 */
|
||
|
|
||
|
/******************************************************************************/
|
||
|
#if ((LINUX_VERSION_CODE < KERNEL_VERSION(3,17,0)) && \
|
||
|
(RHEL_RELEASE_CODE < RHEL_RELEASE_VERSION(7,5)))
|
||
|
#endif /* <3.17.0 && RHEL_RELEASE_CODE < RHEL7.5 */
|
||
|
|
||
|
/******************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(3,18,0) )
|
||
|
#ifndef NO_PTP_SUPPORT
|
||
|
static void __kc_sock_efree(struct sk_buff *skb)
|
||
|
{
|
||
|
sock_put(skb->sk);
|
||
|
}
|
||
|
|
||
|
struct sk_buff *__kc_skb_clone_sk(struct sk_buff *skb)
|
||
|
{
|
||
|
struct sock *sk = skb->sk;
|
||
|
struct sk_buff *clone;
|
||
|
|
||
|
if (!sk || !atomic_inc_not_zero(&sk->sk_refcnt))
|
||
|
return NULL;
|
||
|
|
||
|
clone = skb_clone(skb, GFP_ATOMIC);
|
||
|
if (!clone) {
|
||
|
sock_put(sk);
|
||
|
return NULL;
|
||
|
}
|
||
|
|
||
|
clone->sk = sk;
|
||
|
clone->destructor = __kc_sock_efree;
|
||
|
|
||
|
return clone;
|
||
|
}
|
||
|
|
||
|
void __kc_skb_complete_tx_timestamp(struct sk_buff *skb,
|
||
|
struct skb_shared_hwtstamps *hwtstamps)
|
||
|
{
|
||
|
struct sock_exterr_skb *serr;
|
||
|
struct sock *sk = skb->sk;
|
||
|
int err;
|
||
|
|
||
|
sock_hold(sk);
|
||
|
|
||
|
*skb_hwtstamps(skb) = *hwtstamps;
|
||
|
|
||
|
serr = SKB_EXT_ERR(skb);
|
||
|
memset(serr, 0, sizeof(*serr));
|
||
|
serr->ee.ee_errno = ENOMSG;
|
||
|
serr->ee.ee_origin = SO_EE_ORIGIN_TIMESTAMPING;
|
||
|
|
||
|
err = sock_queue_err_skb(sk, skb);
|
||
|
if (err)
|
||
|
kfree_skb(skb);
|
||
|
|
||
|
sock_put(sk);
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
/* include headers needed for get_headlen function */
|
||
|
#if defined(CONFIG_FCOE) || defined(CONFIG_FCOE_MODULE)
|
||
|
#include <scsi/fc/fc_fcoe.h>
|
||
|
#endif
|
||
|
#ifdef HAVE_SCTP
|
||
|
#include <linux/sctp.h>
|
||
|
#endif
|
||
|
|
||
|
u32 __kc_eth_get_headlen(const struct net_device __always_unused *dev,
|
||
|
unsigned char *data, unsigned int max_len)
|
||
|
{
|
||
|
union {
|
||
|
unsigned char *network;
|
||
|
/* l2 headers */
|
||
|
struct ethhdr *eth;
|
||
|
struct vlan_hdr *vlan;
|
||
|
/* l3 headers */
|
||
|
struct iphdr *ipv4;
|
||
|
struct ipv6hdr *ipv6;
|
||
|
} hdr;
|
||
|
__be16 proto;
|
||
|
u8 nexthdr = 0; /* default to not TCP */
|
||
|
u8 hlen;
|
||
|
|
||
|
/* this should never happen, but better safe than sorry */
|
||
|
if (max_len < ETH_HLEN)
|
||
|
return max_len;
|
||
|
|
||
|
/* initialize network frame pointer */
|
||
|
hdr.network = data;
|
||
|
|
||
|
/* set first protocol and move network header forward */
|
||
|
proto = hdr.eth->h_proto;
|
||
|
hdr.network += ETH_HLEN;
|
||
|
|
||
|
again:
|
||
|
switch (proto) {
|
||
|
/* handle any vlan tag if present */
|
||
|
case __constant_htons(ETH_P_8021AD):
|
||
|
case __constant_htons(ETH_P_8021Q):
|
||
|
if ((hdr.network - data) > (max_len - VLAN_HLEN))
|
||
|
return max_len;
|
||
|
|
||
|
proto = hdr.vlan->h_vlan_encapsulated_proto;
|
||
|
hdr.network += VLAN_HLEN;
|
||
|
goto again;
|
||
|
/* handle L3 protocols */
|
||
|
case __constant_htons(ETH_P_IP):
|
||
|
if ((hdr.network - data) > (max_len - sizeof(struct iphdr)))
|
||
|
return max_len;
|
||
|
|
||
|
/* access ihl as a u8 to avoid unaligned access on ia64 */
|
||
|
hlen = (hdr.network[0] & 0x0F) << 2;
|
||
|
|
||
|
/* verify hlen meets minimum size requirements */
|
||
|
if (hlen < sizeof(struct iphdr))
|
||
|
return hdr.network - data;
|
||
|
|
||
|
/* record next protocol if header is present */
|
||
|
if (!(hdr.ipv4->frag_off & htons(IP_OFFSET)))
|
||
|
nexthdr = hdr.ipv4->protocol;
|
||
|
|
||
|
hdr.network += hlen;
|
||
|
break;
|
||
|
#ifdef NETIF_F_TSO6
|
||
|
case __constant_htons(ETH_P_IPV6):
|
||
|
if ((hdr.network - data) > (max_len - sizeof(struct ipv6hdr)))
|
||
|
return max_len;
|
||
|
|
||
|
/* record next protocol */
|
||
|
nexthdr = hdr.ipv6->nexthdr;
|
||
|
hdr.network += sizeof(struct ipv6hdr);
|
||
|
break;
|
||
|
#endif /* NETIF_F_TSO6 */
|
||
|
#if defined(CONFIG_FCOE) || defined(CONFIG_FCOE_MODULE)
|
||
|
case __constant_htons(ETH_P_FCOE):
|
||
|
hdr.network += FCOE_HEADER_LEN;
|
||
|
break;
|
||
|
#endif
|
||
|
default:
|
||
|
return hdr.network - data;
|
||
|
}
|
||
|
|
||
|
/* finally sort out L4 */
|
||
|
switch (nexthdr) {
|
||
|
case IPPROTO_TCP:
|
||
|
if ((hdr.network - data) > (max_len - sizeof(struct tcphdr)))
|
||
|
return max_len;
|
||
|
|
||
|
/* access doff as a u8 to avoid unaligned access on ia64 */
|
||
|
hdr.network += max_t(u8, sizeof(struct tcphdr),
|
||
|
(hdr.network[12] & 0xF0) >> 2);
|
||
|
|
||
|
break;
|
||
|
case IPPROTO_UDP:
|
||
|
case IPPROTO_UDPLITE:
|
||
|
hdr.network += sizeof(struct udphdr);
|
||
|
break;
|
||
|
#ifdef HAVE_SCTP
|
||
|
case IPPROTO_SCTP:
|
||
|
hdr.network += sizeof(struct sctphdr);
|
||
|
break;
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* If everything has gone correctly hdr.network should be the
|
||
|
* data section of the packet and will be the end of the header.
|
||
|
* If not then it probably represents the end of the last recognized
|
||
|
* header.
|
||
|
*/
|
||
|
return min_t(unsigned int, hdr.network - data, max_len);
|
||
|
}
|
||
|
|
||
|
#endif /* < 3.18.0 */
|
||
|
|
||
|
/******************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(3,19,0) )
|
||
|
#ifdef HAVE_NET_GET_RANDOM_ONCE
|
||
|
static u8 __kc_netdev_rss_key[NETDEV_RSS_KEY_LEN];
|
||
|
|
||
|
void __kc_netdev_rss_key_fill(void *buffer, size_t len)
|
||
|
{
|
||
|
BUG_ON(len > sizeof(__kc_netdev_rss_key));
|
||
|
net_get_random_once(__kc_netdev_rss_key, sizeof(__kc_netdev_rss_key));
|
||
|
memcpy(buffer, __kc_netdev_rss_key, len);
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
int _kc_bitmap_print_to_pagebuf(bool list, char *buf,
|
||
|
const unsigned long *maskp,
|
||
|
int nmaskbits)
|
||
|
{
|
||
|
ptrdiff_t len = PTR_ALIGN(buf + PAGE_SIZE - 1, PAGE_SIZE) - buf - 2;
|
||
|
int n = 0;
|
||
|
|
||
|
if (len > 1) {
|
||
|
n = list ? bitmap_scnlistprintf(buf, len, maskp, nmaskbits) :
|
||
|
bitmap_scnprintf(buf, len, maskp, nmaskbits);
|
||
|
buf[n++] = '\n';
|
||
|
buf[n] = '\0';
|
||
|
}
|
||
|
return n;
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
/******************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,1,0) )
|
||
|
#if !((RHEL_RELEASE_CODE > RHEL_RELEASE_VERSION(6,8) && RHEL_RELEASE_CODE < RHEL_RELEASE_VERSION(7,0)) && \
|
||
|
(RHEL_RELEASE_CODE > RHEL_RELEASE_VERSION(7,2)) && \
|
||
|
(SLE_VERSION_CODE > SLE_VERSION(12,1,0)))
|
||
|
unsigned int _kc_cpumask_local_spread(unsigned int i, int node)
|
||
|
{
|
||
|
int cpu;
|
||
|
|
||
|
/* Wrap: we always want a cpu. */
|
||
|
i %= num_online_cpus();
|
||
|
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,6,28) )
|
||
|
/* Kernels prior to 2.6.28 do not have for_each_cpu or
|
||
|
* cpumask_of_node, so just use for_each_online_cpu()
|
||
|
*/
|
||
|
for_each_online_cpu(cpu)
|
||
|
if (i-- == 0)
|
||
|
return cpu;
|
||
|
|
||
|
return 0;
|
||
|
#else
|
||
|
if (node == -1) {
|
||
|
for_each_cpu(cpu, cpu_online_mask)
|
||
|
if (i-- == 0)
|
||
|
return cpu;
|
||
|
} else {
|
||
|
/* NUMA first. */
|
||
|
for_each_cpu_and(cpu, cpumask_of_node(node), cpu_online_mask)
|
||
|
if (i-- == 0)
|
||
|
return cpu;
|
||
|
|
||
|
for_each_cpu(cpu, cpu_online_mask) {
|
||
|
/* Skip NUMA nodes, done above. */
|
||
|
if (cpumask_test_cpu(cpu, cpumask_of_node(node)))
|
||
|
continue;
|
||
|
|
||
|
if (i-- == 0)
|
||
|
return cpu;
|
||
|
}
|
||
|
}
|
||
|
#endif /* KERNEL_VERSION >= 2.6.28 */
|
||
|
BUG();
|
||
|
}
|
||
|
#endif
|
||
|
#endif
|
||
|
|
||
|
/******************************************************************************/
|
||
|
#if (LINUX_VERSION_CODE < KERNEL_VERSION(4,3,0))
|
||
|
#if (!(RHEL_RELEASE_CODE >= RHEL_RELEASE_VERSION(7,4)) && \
|
||
|
!(SLE_VERSION_CODE >= SLE_VERSION(12,2,0)))
|
||
|
/**
|
||
|
* _kc_skb_flow_dissect_flow_keys - parse SKB to fill _kc_flow_keys
|
||
|
* @skb: SKB used to fille _kc_flow_keys
|
||
|
* @flow: _kc_flow_keys to set with SKB fields
|
||
|
* @flags: currently unused flags
|
||
|
*
|
||
|
* The purpose of using kcompat for this function is so the caller doesn't have
|
||
|
* to care about which kernel version they are on, which prevents a larger than
|
||
|
* normal #ifdef mess created by using a HAVE_* flag for this case. This is also
|
||
|
* done for 4.2 kernels to simplify calling skb_flow_dissect_flow_keys()
|
||
|
* because in 4.2 kernels skb_flow_dissect_flow_keys() exists, but only has 2
|
||
|
* arguments. Recent kernels have skb_flow_dissect_flow_keys() that has 3
|
||
|
* arguments.
|
||
|
*
|
||
|
* The caller needs to understand that this function was only implemented as a
|
||
|
* bare-minimum replacement for recent versions of skb_flow_dissect_flow_keys()
|
||
|
* and this function is in no way similar to skb_flow_dissect_flow_keys(). An
|
||
|
* example use can be found in the ice driver, specifically ice_arfs.c.
|
||
|
*
|
||
|
* This function is treated as a whitelist of supported fields the SKB can
|
||
|
* parse. If new functionality is added make sure to keep this format (i.e. only
|
||
|
* check for fields that are explicity wanted).
|
||
|
*
|
||
|
* Current whitelist:
|
||
|
*
|
||
|
* TCPv4, TCPv6, UDPv4, UDPv6
|
||
|
*
|
||
|
* If any unexpected protocol or other field is found this function memsets the
|
||
|
* flow passed in back to 0 and returns false. Otherwise the flow is populated
|
||
|
* and returns true.
|
||
|
*/
|
||
|
bool
|
||
|
_kc_skb_flow_dissect_flow_keys(const struct sk_buff *skb,
|
||
|
struct _kc_flow_keys *flow,
|
||
|
unsigned int __always_unused flags)
|
||
|
{
|
||
|
memset(flow, 0, sizeof(*flow));
|
||
|
|
||
|
flow->basic.n_proto = skb->protocol;
|
||
|
switch (flow->basic.n_proto) {
|
||
|
case htons(ETH_P_IP):
|
||
|
flow->basic.ip_proto = ip_hdr(skb)->protocol;
|
||
|
flow->addrs.v4addrs.src = ip_hdr(skb)->saddr;
|
||
|
flow->addrs.v4addrs.dst = ip_hdr(skb)->daddr;
|
||
|
break;
|
||
|
case htons(ETH_P_IPV6):
|
||
|
flow->basic.ip_proto = ipv6_hdr(skb)->nexthdr;
|
||
|
memcpy(&flow->addrs.v6addrs.src, &ipv6_hdr(skb)->saddr,
|
||
|
sizeof(struct in6_addr));
|
||
|
memcpy(&flow->addrs.v6addrs.dst, &ipv6_hdr(skb)->daddr,
|
||
|
sizeof(struct in6_addr));
|
||
|
break;
|
||
|
default:
|
||
|
netdev_dbg(skb->dev, "%s: Unsupported/unimplemented layer 3 protocol %04x\n", __func__, htons(flow->basic.n_proto));
|
||
|
goto unsupported;
|
||
|
}
|
||
|
|
||
|
switch (flow->basic.ip_proto) {
|
||
|
case IPPROTO_TCP:
|
||
|
{
|
||
|
struct tcphdr *tcph;
|
||
|
|
||
|
tcph = tcp_hdr(skb);
|
||
|
flow->ports.src = tcph->source;
|
||
|
flow->ports.dst = tcph->dest;
|
||
|
break;
|
||
|
}
|
||
|
case IPPROTO_UDP:
|
||
|
{
|
||
|
struct udphdr *udph;
|
||
|
|
||
|
udph = udp_hdr(skb);
|
||
|
flow->ports.src = udph->source;
|
||
|
flow->ports.dst = udph->dest;
|
||
|
break;
|
||
|
}
|
||
|
default:
|
||
|
netdev_dbg(skb->dev, "%s: Unsupported/unimplemented layer 4 protocol %02x\n", __func__, flow->basic.ip_proto);
|
||
|
return false;
|
||
|
}
|
||
|
|
||
|
return true;
|
||
|
|
||
|
unsupported:
|
||
|
memset(flow, 0, sizeof(*flow));
|
||
|
return false;
|
||
|
}
|
||
|
#endif /* ! >= RHEL7.4 && ! >= SLES12.2 */
|
||
|
#endif /* 4.3.0 */
|
||
|
|
||
|
/******************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,5,0) )
|
||
|
#if (!(RHEL_RELEASE_CODE >= RHEL_RELEASE_VERSION(7,3)))
|
||
|
#ifdef CONFIG_SPARC
|
||
|
#include <asm/idprom.h>
|
||
|
#include <asm/prom.h>
|
||
|
#endif
|
||
|
int _kc_eth_platform_get_mac_address(struct device *dev __maybe_unused,
|
||
|
u8 *mac_addr __maybe_unused)
|
||
|
{
|
||
|
#if (((LINUX_VERSION_CODE < KERNEL_VERSION(3,1,0)) && defined(CONFIG_OF) && \
|
||
|
!defined(HAVE_STRUCT_DEVICE_OF_NODE) || !defined(CONFIG_OF)) && \
|
||
|
!defined(CONFIG_SPARC))
|
||
|
return -ENODEV;
|
||
|
#else
|
||
|
const unsigned char *addr;
|
||
|
struct device_node *dp;
|
||
|
|
||
|
if (dev_is_pci(dev))
|
||
|
dp = pci_device_to_OF_node(to_pci_dev(dev));
|
||
|
else
|
||
|
#if defined(HAVE_STRUCT_DEVICE_OF_NODE) && defined(CONFIG_OF)
|
||
|
dp = dev->of_node;
|
||
|
#else
|
||
|
dp = NULL;
|
||
|
#endif
|
||
|
|
||
|
addr = NULL;
|
||
|
if (dp)
|
||
|
addr = of_get_mac_address(dp);
|
||
|
#ifdef CONFIG_SPARC
|
||
|
/* Kernel hasn't implemented arch_get_platform_mac_address, but we
|
||
|
* should handle the SPARC case here since it was supported
|
||
|
* originally. This is replaced by arch_get_platform_mac_address()
|
||
|
* upstream.
|
||
|
*/
|
||
|
if (!addr)
|
||
|
addr = idprom->id_ethaddr;
|
||
|
#endif
|
||
|
if (!addr)
|
||
|
return -ENODEV;
|
||
|
|
||
|
ether_addr_copy(mac_addr, addr);
|
||
|
return 0;
|
||
|
#endif
|
||
|
}
|
||
|
#endif /* !(RHEL_RELEASE >= 7.3) */
|
||
|
#endif /* < 4.5.0 */
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if ((LINUX_VERSION_CODE < KERNEL_VERSION(4,14,0)) || \
|
||
|
(SLE_VERSION_CODE && (SLE_VERSION_CODE <= SLE_VERSION(12,3,0))) || \
|
||
|
(RHEL_RELEASE_CODE && (RHEL_RELEASE_CODE <= RHEL_RELEASE_VERSION(7,5))))
|
||
|
const char *_kc_phy_speed_to_str(int speed)
|
||
|
{
|
||
|
switch (speed) {
|
||
|
case SPEED_10:
|
||
|
return "10Mbps";
|
||
|
case SPEED_100:
|
||
|
return "100Mbps";
|
||
|
case SPEED_1000:
|
||
|
return "1Gbps";
|
||
|
case SPEED_2500:
|
||
|
return "2.5Gbps";
|
||
|
case SPEED_5000:
|
||
|
return "5Gbps";
|
||
|
case SPEED_10000:
|
||
|
return "10Gbps";
|
||
|
case SPEED_14000:
|
||
|
return "14Gbps";
|
||
|
case SPEED_20000:
|
||
|
return "20Gbps";
|
||
|
case SPEED_25000:
|
||
|
return "25Gbps";
|
||
|
case SPEED_40000:
|
||
|
return "40Gbps";
|
||
|
case SPEED_50000:
|
||
|
return "50Gbps";
|
||
|
case SPEED_56000:
|
||
|
return "56Gbps";
|
||
|
#ifdef SPEED_100000
|
||
|
case SPEED_100000:
|
||
|
return "100Gbps";
|
||
|
#endif
|
||
|
case SPEED_UNKNOWN:
|
||
|
return "Unknown";
|
||
|
default:
|
||
|
return "Unsupported (update phy-core.c)";
|
||
|
}
|
||
|
}
|
||
|
#endif /* (LINUX < 4.14.0) || (SLES <= 12.3.0) || (RHEL <= 7.5) */
|
||
|
|
||
|
/******************************************************************************/
|
||
|
#if ( LINUX_VERSION_CODE < KERNEL_VERSION(4,15,0) )
|
||
|
void _kc_ethtool_intersect_link_masks(struct ethtool_link_ksettings *dst,
|
||
|
struct ethtool_link_ksettings *src)
|
||
|
{
|
||
|
unsigned int size = BITS_TO_LONGS(__ETHTOOL_LINK_MODE_MASK_NBITS);
|
||
|
unsigned int idx = 0;
|
||
|
|
||
|
for (; idx < size; idx++) {
|
||
|
dst->link_modes.supported[idx] &=
|
||
|
src->link_modes.supported[idx];
|
||
|
dst->link_modes.advertising[idx] &=
|
||
|
src->link_modes.advertising[idx];
|
||
|
}
|
||
|
}
|
||
|
#endif /* 4.15.0 */
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if (LINUX_VERSION_CODE < KERNEL_VERSION(4,16,0))
|
||
|
#if !(RHEL_RELEASE_CODE >= RHEL_RELEASE_VERSION(8,0)) && \
|
||
|
!(SLE_VERSION_CODE >= SLE_VERSION(12,5,0) && \
|
||
|
SLE_VERSION_CODE < SLE_VERSION(15,0,0) || \
|
||
|
SLE_VERSION_CODE >= SLE_VERSION(15,1,0))
|
||
|
#if BITS_PER_LONG == 64
|
||
|
/**
|
||
|
* bitmap_from_arr32 - copy the contents of u32 array of bits to bitmap
|
||
|
* @bitmap: array of unsigned longs, the destination bitmap
|
||
|
* @buf: array of u32 (in host byte order), the source bitmap
|
||
|
* @nbits: number of bits in @bitmap
|
||
|
*/
|
||
|
void bitmap_from_arr32(unsigned long *bitmap, const u32 *buf, unsigned int nbits)
|
||
|
{
|
||
|
unsigned int i, halfwords;
|
||
|
|
||
|
halfwords = DIV_ROUND_UP(nbits, 32);
|
||
|
for (i = 0; i < halfwords; i++) {
|
||
|
bitmap[i/2] = (unsigned long) buf[i];
|
||
|
if (++i < halfwords)
|
||
|
bitmap[i/2] |= ((unsigned long) buf[i]) << 32;
|
||
|
}
|
||
|
|
||
|
/* Clear tail bits in last word beyond nbits. */
|
||
|
if (nbits % BITS_PER_LONG)
|
||
|
bitmap[(halfwords - 1) / 2] &= BITMAP_LAST_WORD_MASK(nbits);
|
||
|
}
|
||
|
#endif /* BITS_PER_LONG == 64 */
|
||
|
#endif /* !(RHEL >= 8.0) && !(SLES >= 12.5 && SLES < 15.0 || SLES >= 15.1) */
|
||
|
#endif /* 4.16.0 */
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if (LINUX_VERSION_CODE < KERNEL_VERSION(4,17,0))
|
||
|
/* PCIe link information */
|
||
|
#define PCIE_SPEED2STR(speed) \
|
||
|
((speed) == PCIE_SPEED_16_0GT ? "16 GT/s" : \
|
||
|
(speed) == PCIE_SPEED_8_0GT ? "8 GT/s" : \
|
||
|
(speed) == PCIE_SPEED_5_0GT ? "5 GT/s" : \
|
||
|
(speed) == PCIE_SPEED_2_5GT ? "2.5 GT/s" : \
|
||
|
"Unknown speed")
|
||
|
|
||
|
/* PCIe speed to Mb/s reduced by encoding overhead */
|
||
|
#define PCIE_SPEED2MBS_ENC(speed) \
|
||
|
((speed) == PCIE_SPEED_16_0GT ? 16000*128/130 : \
|
||
|
(speed) == PCIE_SPEED_8_0GT ? 8000*128/130 : \
|
||
|
(speed) == PCIE_SPEED_5_0GT ? 5000*8/10 : \
|
||
|
(speed) == PCIE_SPEED_2_5GT ? 2500*8/10 : \
|
||
|
0)
|
||
|
|
||
|
static u32
|
||
|
_kc_pcie_bandwidth_available(struct pci_dev *dev,
|
||
|
struct pci_dev **limiting_dev,
|
||
|
enum pci_bus_speed *speed,
|
||
|
enum pcie_link_width *width)
|
||
|
{
|
||
|
u16 lnksta;
|
||
|
enum pci_bus_speed next_speed;
|
||
|
enum pcie_link_width next_width;
|
||
|
u32 bw, next_bw;
|
||
|
|
||
|
if (speed)
|
||
|
*speed = PCI_SPEED_UNKNOWN;
|
||
|
if (width)
|
||
|
*width = PCIE_LNK_WIDTH_UNKNOWN;
|
||
|
|
||
|
bw = 0;
|
||
|
|
||
|
while (dev) {
|
||
|
pcie_capability_read_word(dev, PCI_EXP_LNKSTA, &lnksta);
|
||
|
|
||
|
next_speed = pcie_link_speed[lnksta & PCI_EXP_LNKSTA_CLS];
|
||
|
next_width = (lnksta & PCI_EXP_LNKSTA_NLW) >>
|
||
|
PCI_EXP_LNKSTA_NLW_SHIFT;
|
||
|
|
||
|
next_bw = next_width * PCIE_SPEED2MBS_ENC(next_speed);
|
||
|
|
||
|
/* Check if current device limits the total bandwidth */
|
||
|
if (!bw || next_bw <= bw) {
|
||
|
bw = next_bw;
|
||
|
|
||
|
if (limiting_dev)
|
||
|
*limiting_dev = dev;
|
||
|
if (speed)
|
||
|
*speed = next_speed;
|
||
|
if (width)
|
||
|
*width = next_width;
|
||
|
}
|
||
|
|
||
|
dev = pci_upstream_bridge(dev);
|
||
|
}
|
||
|
|
||
|
return bw;
|
||
|
}
|
||
|
|
||
|
static enum pci_bus_speed _kc_pcie_get_speed_cap(struct pci_dev *dev)
|
||
|
{
|
||
|
u32 lnkcap2, lnkcap;
|
||
|
|
||
|
/*
|
||
|
* PCIe r4.0 sec 7.5.3.18 recommends using the Supported Link
|
||
|
* Speeds Vector in Link Capabilities 2 when supported, falling
|
||
|
* back to Max Link Speed in Link Capabilities otherwise.
|
||
|
*/
|
||
|
pcie_capability_read_dword(dev, PCI_EXP_LNKCAP2, &lnkcap2);
|
||
|
if (lnkcap2) { /* PCIe r3.0-compliant */
|
||
|
if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_16_0GB)
|
||
|
return PCIE_SPEED_16_0GT;
|
||
|
else if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_8_0GB)
|
||
|
return PCIE_SPEED_8_0GT;
|
||
|
else if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_5_0GB)
|
||
|
return PCIE_SPEED_5_0GT;
|
||
|
else if (lnkcap2 & PCI_EXP_LNKCAP2_SLS_2_5GB)
|
||
|
return PCIE_SPEED_2_5GT;
|
||
|
return PCI_SPEED_UNKNOWN;
|
||
|
}
|
||
|
|
||
|
pcie_capability_read_dword(dev, PCI_EXP_LNKCAP, &lnkcap);
|
||
|
if (lnkcap) {
|
||
|
if (lnkcap & PCI_EXP_LNKCAP_SLS_16_0GB)
|
||
|
return PCIE_SPEED_16_0GT;
|
||
|
else if (lnkcap & PCI_EXP_LNKCAP_SLS_8_0GB)
|
||
|
return PCIE_SPEED_8_0GT;
|
||
|
else if (lnkcap & PCI_EXP_LNKCAP_SLS_5_0GB)
|
||
|
return PCIE_SPEED_5_0GT;
|
||
|
else if (lnkcap & PCI_EXP_LNKCAP_SLS_2_5GB)
|
||
|
return PCIE_SPEED_2_5GT;
|
||
|
}
|
||
|
|
||
|
return PCI_SPEED_UNKNOWN;
|
||
|
}
|
||
|
|
||
|
static enum pcie_link_width _kc_pcie_get_width_cap(struct pci_dev *dev)
|
||
|
{
|
||
|
u32 lnkcap;
|
||
|
|
||
|
pcie_capability_read_dword(dev, PCI_EXP_LNKCAP, &lnkcap);
|
||
|
if (lnkcap)
|
||
|
return (lnkcap & PCI_EXP_LNKCAP_MLW) >> 4;
|
||
|
|
||
|
return PCIE_LNK_WIDTH_UNKNOWN;
|
||
|
}
|
||
|
|
||
|
static u32
|
||
|
_kc_pcie_bandwidth_capable(struct pci_dev *dev, enum pci_bus_speed *speed,
|
||
|
enum pcie_link_width *width)
|
||
|
{
|
||
|
*speed = _kc_pcie_get_speed_cap(dev);
|
||
|
*width = _kc_pcie_get_width_cap(dev);
|
||
|
|
||
|
if (*speed == PCI_SPEED_UNKNOWN || *width == PCIE_LNK_WIDTH_UNKNOWN)
|
||
|
return 0;
|
||
|
|
||
|
return *width * PCIE_SPEED2MBS_ENC(*speed);
|
||
|
}
|
||
|
|
||
|
void _kc_pcie_print_link_status(struct pci_dev *dev) {
|
||
|
enum pcie_link_width width, width_cap;
|
||
|
enum pci_bus_speed speed, speed_cap;
|
||
|
struct pci_dev *limiting_dev = NULL;
|
||
|
u32 bw_avail, bw_cap;
|
||
|
|
||
|
bw_cap = _kc_pcie_bandwidth_capable(dev, &speed_cap, &width_cap);
|
||
|
bw_avail = _kc_pcie_bandwidth_available(dev, &limiting_dev, &speed,
|
||
|
&width);
|
||
|
|
||
|
if (bw_avail >= bw_cap)
|
||
|
pci_info(dev, "%u.%03u Gb/s available PCIe bandwidth (%s x%d link)\n",
|
||
|
bw_cap / 1000, bw_cap % 1000,
|
||
|
PCIE_SPEED2STR(speed_cap), width_cap);
|
||
|
else
|
||
|
pci_info(dev, "%u.%03u Gb/s available PCIe bandwidth, limited by %s x%d link at %s (capable of %u.%03u Gb/s with %s x%d link)\n",
|
||
|
bw_avail / 1000, bw_avail % 1000,
|
||
|
PCIE_SPEED2STR(speed), width,
|
||
|
limiting_dev ? pci_name(limiting_dev) : "<unknown>",
|
||
|
bw_cap / 1000, bw_cap % 1000,
|
||
|
PCIE_SPEED2STR(speed_cap), width_cap);
|
||
|
}
|
||
|
#endif /* 4.17.0 */
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if (LINUX_VERSION_CODE < KERNEL_VERSION(5,1,0)) || (RHEL_RELEASE_CODE && (RHEL_RELEASE_CODE < RHEL_RELEASE_VERSION(8,1)))
|
||
|
#ifdef HAVE_TC_SETUP_CLSFLOWER
|
||
|
#define FLOW_DISSECTOR_MATCH(__rule, __type, __out) \
|
||
|
const struct flow_match *__m = &(__rule)->match; \
|
||
|
struct flow_dissector *__d = (__m)->dissector; \
|
||
|
\
|
||
|
(__out)->key = skb_flow_dissector_target(__d, __type, (__m)->key); \
|
||
|
(__out)->mask = skb_flow_dissector_target(__d, __type, (__m)->mask); \
|
||
|
|
||
|
void flow_rule_match_basic(const struct flow_rule *rule,
|
||
|
struct flow_match_basic *out)
|
||
|
{
|
||
|
FLOW_DISSECTOR_MATCH(rule, FLOW_DISSECTOR_KEY_BASIC, out);
|
||
|
}
|
||
|
|
||
|
void flow_rule_match_control(const struct flow_rule *rule,
|
||
|
struct flow_match_control *out)
|
||
|
{
|
||
|
FLOW_DISSECTOR_MATCH(rule, FLOW_DISSECTOR_KEY_CONTROL, out);
|
||
|
}
|
||
|
|
||
|
void flow_rule_match_eth_addrs(const struct flow_rule *rule,
|
||
|
struct flow_match_eth_addrs *out)
|
||
|
{
|
||
|
FLOW_DISSECTOR_MATCH(rule, FLOW_DISSECTOR_KEY_ETH_ADDRS, out);
|
||
|
}
|
||
|
|
||
|
#ifdef HAVE_TC_FLOWER_ENC
|
||
|
void flow_rule_match_enc_keyid(const struct flow_rule *rule,
|
||
|
struct flow_match_enc_keyid *out)
|
||
|
{
|
||
|
FLOW_DISSECTOR_MATCH(rule, FLOW_DISSECTOR_KEY_ENC_KEYID, out);
|
||
|
}
|
||
|
|
||
|
void flow_rule_match_enc_ports(const struct flow_rule *rule,
|
||
|
struct flow_match_ports *out)
|
||
|
{
|
||
|
FLOW_DISSECTOR_MATCH(rule, FLOW_DISSECTOR_KEY_ENC_PORTS, out);
|
||
|
}
|
||
|
|
||
|
void flow_rule_match_enc_control(const struct flow_rule *rule,
|
||
|
struct flow_match_control *out)
|
||
|
{
|
||
|
FLOW_DISSECTOR_MATCH(rule, FLOW_DISSECTOR_KEY_ENC_CONTROL, out);
|
||
|
}
|
||
|
|
||
|
void flow_rule_match_enc_ipv4_addrs(const struct flow_rule *rule,
|
||
|
struct flow_match_ipv4_addrs *out)
|
||
|
{
|
||
|
FLOW_DISSECTOR_MATCH(rule, FLOW_DISSECTOR_KEY_ENC_IPV4_ADDRS, out);
|
||
|
}
|
||
|
|
||
|
void flow_rule_match_enc_ipv6_addrs(const struct flow_rule *rule,
|
||
|
struct flow_match_ipv6_addrs *out)
|
||
|
{
|
||
|
FLOW_DISSECTOR_MATCH(rule, FLOW_DISSECTOR_KEY_ENC_IPV6_ADDRS, out);
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
#ifndef HAVE_TC_FLOWER_VLAN_IN_TAGS
|
||
|
void flow_rule_match_vlan(const struct flow_rule *rule,
|
||
|
struct flow_match_vlan *out)
|
||
|
{
|
||
|
FLOW_DISSECTOR_MATCH(rule, FLOW_DISSECTOR_KEY_VLAN, out);
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
void flow_rule_match_ipv4_addrs(const struct flow_rule *rule,
|
||
|
struct flow_match_ipv4_addrs *out)
|
||
|
{
|
||
|
FLOW_DISSECTOR_MATCH(rule, FLOW_DISSECTOR_KEY_IPV4_ADDRS, out);
|
||
|
}
|
||
|
|
||
|
void flow_rule_match_ipv6_addrs(const struct flow_rule *rule,
|
||
|
struct flow_match_ipv6_addrs *out)
|
||
|
{
|
||
|
FLOW_DISSECTOR_MATCH(rule, FLOW_DISSECTOR_KEY_IPV6_ADDRS, out);
|
||
|
}
|
||
|
|
||
|
void flow_rule_match_ports(const struct flow_rule *rule,
|
||
|
struct flow_match_ports *out)
|
||
|
{
|
||
|
FLOW_DISSECTOR_MATCH(rule, FLOW_DISSECTOR_KEY_PORTS, out);
|
||
|
}
|
||
|
#endif /* HAVE_TC_SETUP_CLSFLOWER */
|
||
|
#endif /* 5.1.0 || (RHEL && RHEL < 8.1) */
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if (LINUX_VERSION_CODE < KERNEL_VERSION(5,3,0))
|
||
|
#if (!(RHEL_RELEASE_CODE && (RHEL_RELEASE_CODE >= RHEL_RELEASE_VERSION(8,2))))
|
||
|
#ifdef HAVE_TC_CB_AND_SETUP_QDISC_MQPRIO
|
||
|
int _kc_flow_block_cb_setup_simple(struct flow_block_offload *f,
|
||
|
struct list_head __always_unused *driver_list,
|
||
|
tc_setup_cb_t *cb,
|
||
|
void *cb_ident, void *cb_priv,
|
||
|
bool ingress_only)
|
||
|
{
|
||
|
if (ingress_only &&
|
||
|
f->binder_type != TCF_BLOCK_BINDER_TYPE_CLSACT_INGRESS)
|
||
|
return -EOPNOTSUPP;
|
||
|
|
||
|
/* Note: Upstream has driver_block_list, but older kernels do not */
|
||
|
switch (f->command) {
|
||
|
case TC_BLOCK_BIND:
|
||
|
#ifdef HAVE_TCF_BLOCK_CB_REGISTER_EXTACK
|
||
|
return tcf_block_cb_register(f->block, cb, cb_ident, cb_priv,
|
||
|
f->extack);
|
||
|
#else
|
||
|
return tcf_block_cb_register(f->block, cb, cb_ident, cb_priv);
|
||
|
#endif
|
||
|
case TC_BLOCK_UNBIND:
|
||
|
tcf_block_cb_unregister(f->block, cb, cb_ident);
|
||
|
return 0;
|
||
|
default:
|
||
|
return -EOPNOTSUPP;
|
||
|
}
|
||
|
}
|
||
|
#endif /* HAVE_TC_CB_AND_SETUP_QDISC_MQPRIO */
|
||
|
#endif /* !RHEL >= 8.2 */
|
||
|
#endif /* 5.3.0 */
|
||
|
|
||
|
/*****************************************************************************/
|
||
|
#if (LINUX_VERSION_CODE < KERNEL_VERSION(5,7,0))
|
||
|
u64 _kc_pci_get_dsn(struct pci_dev *dev)
|
||
|
{
|
||
|
u32 dword;
|
||
|
u64 dsn;
|
||
|
int pos;
|
||
|
|
||
|
pos = pci_find_ext_capability(dev, PCI_EXT_CAP_ID_DSN);
|
||
|
if (!pos)
|
||
|
return 0;
|
||
|
|
||
|
/*
|
||
|
* The Device Serial Number is two dwords offset 4 bytes from the
|
||
|
* capability position. The specification says that the first dword is
|
||
|
* the lower half, and the second dword is the upper half.
|
||
|
*/
|
||
|
pos += 4;
|
||
|
pci_read_config_dword(dev, pos, &dword);
|
||
|
dsn = (u64)dword;
|
||
|
pci_read_config_dword(dev, pos + 4, &dword);
|
||
|
dsn |= ((u64)dword) << 32;
|
||
|
|
||
|
return dsn;
|
||
|
}
|
||
|
#endif /* 5.7.0 */
|