308 lines
9.6 KiB
C
308 lines
9.6 KiB
C
/* Copyright (c) 2008-2013, The Linux Foundation. All rights reserved.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 and
|
|
* only 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.
|
|
*
|
|
*/
|
|
|
|
#include <linux/init.h>
|
|
#include <linux/module.h>
|
|
#include <linux/mempool.h>
|
|
#include <linux/mutex.h>
|
|
#include <asm/atomic.h>
|
|
#include "diagchar.h"
|
|
#include "diagfwd_bridge.h"
|
|
#include "diagfwd_hsic.h"
|
|
|
|
void *diagmem_alloc(struct diagchar_dev *driver, int size, int pool_type)
|
|
{
|
|
void *buf = NULL;
|
|
int index;
|
|
|
|
index = 0;
|
|
if (pool_type == POOL_TYPE_COPY) {
|
|
if (driver->diagpool) {
|
|
mutex_lock(&driver->diagmem_mutex);
|
|
if (driver->count < driver->poolsize) {
|
|
atomic_add(1, (atomic_t *)&driver->count);
|
|
buf = mempool_alloc(driver->diagpool,
|
|
GFP_ATOMIC);
|
|
}
|
|
mutex_unlock(&driver->diagmem_mutex);
|
|
}
|
|
} else if (pool_type == POOL_TYPE_HDLC) {
|
|
if (driver->diag_hdlc_pool) {
|
|
if (driver->count_hdlc_pool < driver->poolsize_hdlc) {
|
|
atomic_add(1,
|
|
(atomic_t *)&driver->count_hdlc_pool);
|
|
buf = mempool_alloc(driver->diag_hdlc_pool,
|
|
GFP_ATOMIC);
|
|
}
|
|
}
|
|
} else if (pool_type == POOL_TYPE_USER) {
|
|
if (driver->diag_user_pool) {
|
|
if (driver->count_user_pool < driver->poolsize_user) {
|
|
atomic_add(1,
|
|
(atomic_t *)&driver->count_user_pool);
|
|
buf = mempool_alloc(driver->diag_user_pool,
|
|
GFP_ATOMIC);
|
|
}
|
|
}
|
|
} else if (pool_type == POOL_TYPE_WRITE_STRUCT) {
|
|
if (driver->diag_write_struct_pool) {
|
|
if (driver->count_write_struct_pool <
|
|
driver->poolsize_write_struct) {
|
|
atomic_add(1,
|
|
(atomic_t *)&driver->count_write_struct_pool);
|
|
buf = mempool_alloc(
|
|
driver->diag_write_struct_pool, GFP_ATOMIC);
|
|
}
|
|
}
|
|
#ifdef CONFIG_DIAGFWD_BRIDGE_CODE
|
|
} else if (pool_type == POOL_TYPE_HSIC ||
|
|
pool_type == POOL_TYPE_HSIC_2) {
|
|
index = pool_type - POOL_TYPE_HSIC;
|
|
if (diag_hsic[index].diag_hsic_pool) {
|
|
if (diag_hsic[index].count_hsic_pool <
|
|
diag_hsic[index].poolsize_hsic) {
|
|
atomic_add(1, (atomic_t *)
|
|
&diag_hsic[index].count_hsic_pool);
|
|
buf = mempool_alloc(
|
|
diag_hsic[index].diag_hsic_pool,
|
|
GFP_ATOMIC);
|
|
}
|
|
}
|
|
} else if (pool_type == POOL_TYPE_HSIC_WRITE ||
|
|
pool_type == POOL_TYPE_HSIC_2_WRITE) {
|
|
index = pool_type - POOL_TYPE_HSIC_WRITE;
|
|
if (diag_hsic[index].diag_hsic_write_pool) {
|
|
if (diag_hsic[index].count_hsic_write_pool <
|
|
diag_hsic[index].poolsize_hsic_write) {
|
|
atomic_add(1, (atomic_t *)
|
|
&diag_hsic[index].
|
|
count_hsic_write_pool);
|
|
buf = mempool_alloc(
|
|
diag_hsic[index].diag_hsic_write_pool,
|
|
GFP_ATOMIC);
|
|
}
|
|
}
|
|
#endif
|
|
}
|
|
return buf;
|
|
}
|
|
|
|
void diagmem_exit(struct diagchar_dev *driver, int pool_type)
|
|
{
|
|
int index;
|
|
index = 0;
|
|
|
|
if (driver->diagpool) {
|
|
if (driver->count == 0 && driver->ref_count == 0) {
|
|
mempool_destroy(driver->diagpool);
|
|
driver->diagpool = NULL;
|
|
} else if (driver->ref_count == 0 && pool_type ==
|
|
POOL_TYPE_ALL) {
|
|
pr_err("diag: Unable to destroy COPY mempool");
|
|
}
|
|
}
|
|
|
|
if (driver->diag_hdlc_pool) {
|
|
if (driver->count_hdlc_pool == 0 && driver->ref_count == 0) {
|
|
mempool_destroy(driver->diag_hdlc_pool);
|
|
driver->diag_hdlc_pool = NULL;
|
|
} else if (driver->ref_count == 0 && pool_type ==
|
|
POOL_TYPE_ALL) {
|
|
pr_err("diag: Unable to destroy HDLC mempool");
|
|
}
|
|
}
|
|
|
|
if (driver->diag_user_pool) {
|
|
if (driver->count_user_pool == 0 && driver->ref_count == 0) {
|
|
mempool_destroy(driver->diag_user_pool);
|
|
driver->diag_user_pool = NULL;
|
|
} else if (driver->ref_count == 0 && pool_type ==
|
|
POOL_TYPE_ALL) {
|
|
pr_err("diag: Unable to destroy USER mempool");
|
|
}
|
|
}
|
|
|
|
if (driver->diag_write_struct_pool) {
|
|
/* Free up struct pool ONLY if there are no outstanding
|
|
transactions(aggregation buffer) with USB */
|
|
if (driver->count_write_struct_pool == 0 &&
|
|
driver->count_hdlc_pool == 0 && driver->ref_count == 0) {
|
|
mempool_destroy(driver->diag_write_struct_pool);
|
|
driver->diag_write_struct_pool = NULL;
|
|
} else if (driver->ref_count == 0 && pool_type ==
|
|
POOL_TYPE_ALL) {
|
|
pr_err("diag: Unable to destroy STRUCT mempool");
|
|
}
|
|
}
|
|
#ifdef CONFIG_DIAGFWD_BRIDGE_CODE
|
|
for (index = 0; index < MAX_HSIC_CH; index++) {
|
|
if (diag_hsic[index].diag_hsic_pool &&
|
|
(diag_hsic[index].hsic_inited == 0)) {
|
|
if (diag_hsic[index].count_hsic_pool == 0) {
|
|
mempool_destroy(
|
|
diag_hsic[index].diag_hsic_pool);
|
|
diag_hsic[index].diag_hsic_pool = NULL;
|
|
} else if (pool_type == POOL_TYPE_ALL)
|
|
pr_err("Unable to destroy HDLC mempool for ch %d"
|
|
, index);
|
|
}
|
|
|
|
if (diag_hsic[index].diag_hsic_write_pool &&
|
|
(diag_hsic[index].hsic_inited == 0)) {
|
|
/*
|
|
* Free up struct pool ONLY if there are no outstanding
|
|
* transactions(aggregation buffer) with USB
|
|
*/
|
|
if (diag_hsic[index].count_hsic_write_pool == 0 &&
|
|
diag_hsic[index].count_hsic_pool == 0) {
|
|
mempool_destroy(
|
|
diag_hsic[index].diag_hsic_write_pool);
|
|
diag_hsic[index].diag_hsic_write_pool = NULL;
|
|
} else if (pool_type == POOL_TYPE_ALL)
|
|
pr_err("Unable to destroy HSIC USB struct mempool for ch %d"
|
|
, index);
|
|
}
|
|
}
|
|
#endif
|
|
}
|
|
|
|
void diagmem_free(struct diagchar_dev *driver, void *buf, int pool_type)
|
|
{
|
|
int index;
|
|
|
|
index = 0;
|
|
if (pool_type == POOL_TYPE_COPY) {
|
|
if (driver->diagpool != NULL && driver->count > 0) {
|
|
mempool_free(buf, driver->diagpool);
|
|
atomic_add(-1, (atomic_t *)&driver->count);
|
|
} else
|
|
pr_err("diag: Attempt to free up DIAG driver mempool memory which is already free %d",
|
|
driver->count);
|
|
} else if (pool_type == POOL_TYPE_HDLC) {
|
|
if (driver->diag_hdlc_pool != NULL &&
|
|
driver->count_hdlc_pool > 0) {
|
|
mempool_free(buf, driver->diag_hdlc_pool);
|
|
atomic_add(-1, (atomic_t *)&driver->count_hdlc_pool);
|
|
} else
|
|
pr_err("diag: Attempt to free up DIAG driver HDLC mempool which is already free %d ",
|
|
driver->count_hdlc_pool);
|
|
} else if (pool_type == POOL_TYPE_USER) {
|
|
if (driver->diag_user_pool != NULL &&
|
|
driver->count_user_pool > 0) {
|
|
mempool_free(buf, driver->diag_user_pool);
|
|
atomic_add(-1, (atomic_t *)&driver->count_user_pool);
|
|
} else {
|
|
pr_err("diag: Attempt to free up DIAG driver USER mempool which is already free %d ",
|
|
driver->count_user_pool);
|
|
}
|
|
} else if (pool_type == POOL_TYPE_WRITE_STRUCT) {
|
|
if (driver->diag_write_struct_pool != NULL &&
|
|
driver->count_write_struct_pool > 0) {
|
|
mempool_free(buf, driver->diag_write_struct_pool);
|
|
atomic_add(-1,
|
|
(atomic_t *)&driver->count_write_struct_pool);
|
|
} else
|
|
pr_err("diag: Attempt to free up DIAG driver USB structure mempool which is already free %d ",
|
|
driver->count_write_struct_pool);
|
|
#ifdef CONFIG_DIAGFWD_BRIDGE_CODE
|
|
} else if (pool_type == POOL_TYPE_HSIC ||
|
|
pool_type == POOL_TYPE_HSIC_2) {
|
|
index = pool_type - POOL_TYPE_HSIC;
|
|
if (diag_hsic[index].diag_hsic_pool != NULL &&
|
|
diag_hsic[index].count_hsic_pool > 0) {
|
|
mempool_free(buf, diag_hsic[index].diag_hsic_pool);
|
|
atomic_add(-1, (atomic_t *)
|
|
&diag_hsic[index].count_hsic_pool);
|
|
} else
|
|
pr_err("diag: Attempt to free up DIAG driver HSIC mempool which is already free %d, ch = %d",
|
|
diag_hsic[index].count_hsic_pool, index);
|
|
} else if (pool_type == POOL_TYPE_HSIC_WRITE ||
|
|
pool_type == POOL_TYPE_HSIC_2_WRITE) {
|
|
index = pool_type - POOL_TYPE_HSIC_WRITE;
|
|
if (diag_hsic[index].diag_hsic_write_pool != NULL &&
|
|
diag_hsic[index].count_hsic_write_pool > 0) {
|
|
mempool_free(buf,
|
|
diag_hsic[index].diag_hsic_write_pool);
|
|
atomic_add(-1, (atomic_t *)
|
|
&diag_hsic[index].count_hsic_write_pool);
|
|
} else
|
|
pr_err("diag: Attempt to free up DIAG driver HSIC USB structure mempool which is already free %d, ch = %d",
|
|
driver->count_write_struct_pool, index);
|
|
#endif
|
|
} else {
|
|
pr_err("diag: In %s, unknown pool type: %d\n",
|
|
__func__, pool_type);
|
|
|
|
}
|
|
|
|
diagmem_exit(driver, pool_type);
|
|
}
|
|
|
|
void diagmem_init(struct diagchar_dev *driver)
|
|
{
|
|
mutex_init(&driver->diagmem_mutex);
|
|
|
|
if (driver->count == 0)
|
|
driver->diagpool = mempool_create_kmalloc_pool(
|
|
driver->poolsize, driver->itemsize);
|
|
|
|
if (driver->count_hdlc_pool == 0)
|
|
driver->diag_hdlc_pool = mempool_create_kmalloc_pool(
|
|
driver->poolsize_hdlc, driver->itemsize_hdlc);
|
|
|
|
if (driver->count_user_pool == 0)
|
|
driver->diag_user_pool = mempool_create_kmalloc_pool(
|
|
driver->poolsize_user, driver->itemsize_user);
|
|
|
|
if (driver->count_write_struct_pool == 0)
|
|
driver->diag_write_struct_pool = mempool_create_kmalloc_pool(
|
|
driver->poolsize_write_struct, driver->itemsize_write_struct);
|
|
|
|
if (!driver->diagpool)
|
|
pr_err("diag: Cannot allocate diag mempool\n");
|
|
|
|
if (!driver->diag_hdlc_pool)
|
|
pr_err("diag: Cannot allocate diag HDLC mempool\n");
|
|
|
|
if (!driver->diag_user_pool)
|
|
pr_err("diag: Cannot allocate diag USER mempool\n");
|
|
|
|
if (!driver->diag_write_struct_pool)
|
|
pr_err("diag: Cannot allocate diag USB struct mempool\n");
|
|
}
|
|
|
|
#ifdef CONFIG_DIAGFWD_BRIDGE_CODE
|
|
void diagmem_hsic_init(int index)
|
|
{
|
|
if (diag_hsic[index].count_hsic_pool == 0)
|
|
diag_hsic[index].diag_hsic_pool = mempool_create_kmalloc_pool(
|
|
diag_hsic[index].poolsize_hsic,
|
|
diag_hsic[index].itemsize_hsic);
|
|
|
|
if (diag_hsic[index].count_hsic_write_pool == 0)
|
|
diag_hsic[index].diag_hsic_write_pool =
|
|
mempool_create_kmalloc_pool(
|
|
diag_hsic[index].poolsize_hsic_write,
|
|
diag_hsic[index].itemsize_hsic_write);
|
|
|
|
if (!diag_hsic[index].diag_hsic_pool)
|
|
pr_err("Cannot allocate diag HSIC mempool for ch %d\n", index);
|
|
|
|
if (!diag_hsic[index].diag_hsic_write_pool)
|
|
pr_err("Cannot allocate diag HSIC struct mempool for ch %d\n",
|
|
index);
|
|
|
|
}
|
|
#endif
|
|
|