Scott Feldman | f8bd909 | 2010-05-17 22:50:19 -0700 | [diff] [blame] | 1 | /* |
| 2 | * Copyright 2010 Cisco Systems, Inc. All rights reserved. |
| 3 | * |
| 4 | * This program is free software; you may redistribute it and/or modify |
| 5 | * it under the terms of the GNU General Public License as published by |
| 6 | * the Free Software Foundation; version 2 of the License. |
| 7 | * |
| 8 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, |
| 9 | * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF |
| 10 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND |
| 11 | * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS |
| 12 | * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN |
| 13 | * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN |
| 14 | * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE |
| 15 | * SOFTWARE. |
| 16 | * |
| 17 | */ |
| 18 | |
| 19 | #include <linux/kernel.h> |
| 20 | #include <linux/errno.h> |
| 21 | #include <linux/types.h> |
| 22 | #include <linux/slab.h> |
| 23 | |
| 24 | #include "vnic_vic.h" |
| 25 | |
Roopa Prabhu | 756462f | 2011-03-29 20:36:02 +0000 | [diff] [blame] | 26 | struct vic_provinfo *vic_provinfo_alloc(gfp_t flags, const u8 *oui, |
| 27 | const u8 type) |
Scott Feldman | f8bd909 | 2010-05-17 22:50:19 -0700 | [diff] [blame] | 28 | { |
Dan Carpenter | fc0ba8e | 2010-06-09 21:59:03 +0000 | [diff] [blame] | 29 | struct vic_provinfo *vp; |
Scott Feldman | f8bd909 | 2010-05-17 22:50:19 -0700 | [diff] [blame] | 30 | |
Vasanthy Kolluri | 29046f9 | 2010-06-24 10:52:26 +0000 | [diff] [blame] | 31 | if (!oui) |
| 32 | return NULL; |
| 33 | |
Dan Carpenter | fc0ba8e | 2010-06-09 21:59:03 +0000 | [diff] [blame] | 34 | vp = kzalloc(VIC_PROVINFO_MAX_DATA, flags); |
| 35 | if (!vp) |
Scott Feldman | f8bd909 | 2010-05-17 22:50:19 -0700 | [diff] [blame] | 36 | return NULL; |
| 37 | |
| 38 | memcpy(vp->oui, oui, sizeof(vp->oui)); |
| 39 | vp->type = type; |
| 40 | vp->length = htonl(sizeof(vp->num_tlvs)); |
| 41 | |
| 42 | return vp; |
| 43 | } |
| 44 | |
| 45 | void vic_provinfo_free(struct vic_provinfo *vp) |
| 46 | { |
| 47 | kfree(vp); |
| 48 | } |
| 49 | |
| 50 | int vic_provinfo_add_tlv(struct vic_provinfo *vp, u16 type, u16 length, |
Roopa Prabhu | 756462f | 2011-03-29 20:36:02 +0000 | [diff] [blame] | 51 | const void *value) |
Scott Feldman | f8bd909 | 2010-05-17 22:50:19 -0700 | [diff] [blame] | 52 | { |
| 53 | struct vic_provinfo_tlv *tlv; |
| 54 | |
| 55 | if (!vp || !value) |
| 56 | return -EINVAL; |
| 57 | |
Roopa Prabhu | 7c46835 | 2010-08-10 18:55:10 +0000 | [diff] [blame] | 58 | if (ntohl(vp->length) + offsetof(struct vic_provinfo_tlv, value) + |
| 59 | length > VIC_PROVINFO_MAX_TLV_DATA) |
Scott Feldman | f8bd909 | 2010-05-17 22:50:19 -0700 | [diff] [blame] | 60 | return -ENOMEM; |
| 61 | |
| 62 | tlv = (struct vic_provinfo_tlv *)((u8 *)vp->tlv + |
| 63 | ntohl(vp->length) - sizeof(vp->num_tlvs)); |
| 64 | |
| 65 | tlv->type = htons(type); |
| 66 | tlv->length = htons(length); |
| 67 | memcpy(tlv->value, value, length); |
| 68 | |
| 69 | vp->num_tlvs = htonl(ntohl(vp->num_tlvs) + 1); |
Roopa Prabhu | 7c46835 | 2010-08-10 18:55:10 +0000 | [diff] [blame] | 70 | vp->length = htonl(ntohl(vp->length) + |
| 71 | offsetof(struct vic_provinfo_tlv, value) + length); |
Scott Feldman | f8bd909 | 2010-05-17 22:50:19 -0700 | [diff] [blame] | 72 | |
| 73 | return 0; |
| 74 | } |
| 75 | |
| 76 | size_t vic_provinfo_size(struct vic_provinfo *vp) |
| 77 | { |
| 78 | return vp ? ntohl(vp->length) + sizeof(*vp) - sizeof(vp->num_tlvs) : 0; |
| 79 | } |