[media] staging: easycap: Split easycap_delete() into several pieces
The patch splits easycap_delete(), which is in charge of buffer deallocation, into smaller functions each deallocating a specific kind of buffer. Signed-off-by: Ezequiel Garcia <elezegarcia@gmail.com> Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>
This commit is contained in:
Ezequiel García
Mauro Carvalho Chehab
Родитель
df8c4b7232
Коммит
92a0144225
|
|
@ -701,202 +701,6 @@ static int videodev_release(struct video_device *pvideo_device)
|
|||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* This function is called from within easycap_usb_disconnect() and is
|
||||
* protected by semaphores set and cleared by easycap_usb_disconnect().
|
||||
* By this stage the device has already been physically unplugged,
|
||||
* so peasycap->pusb_device is no longer valid.
|
||||
*/
|
||||
static void easycap_delete(struct kref *pkref)
|
||||
{
|
||||
struct easycap *peasycap;
|
||||
struct data_urb *pdata_urb;
|
||||
struct list_head *plist_head, *plist_next;
|
||||
int k, m, gone, kd;
|
||||
int allocation_video_urb;
|
||||
int allocation_video_page;
|
||||
int allocation_video_struct;
|
||||
int allocation_audio_urb;
|
||||
int allocation_audio_page;
|
||||
int allocation_audio_struct;
|
||||
int registered_video, registered_audio;
|
||||
|
||||
peasycap = container_of(pkref, struct easycap, kref);
|
||||
if (!peasycap) {
|
||||
SAM("ERROR: peasycap is NULL: cannot perform deletions\n");
|
||||
return;
|
||||
}
|
||||
kd = easycap_isdongle(peasycap);
|
||||
|
||||
/* Free video urbs */
|
||||
if (peasycap->purb_video_head) {
|
||||
m = 0;
|
||||
list_for_each(plist_head, peasycap->purb_video_head) {
|
||||
pdata_urb = list_entry(plist_head,
|
||||
struct data_urb, list_head);
|
||||
if (pdata_urb && pdata_urb->purb) {
|
||||
usb_free_urb(pdata_urb->purb);
|
||||
pdata_urb->purb = NULL;
|
||||
peasycap->allocation_video_urb--;
|
||||
m++;
|
||||
}
|
||||
}
|
||||
|
||||
JOM(4, "%i video urbs freed\n", m);
|
||||
JOM(4, "freeing video data_urb structures.\n");
|
||||
m = 0;
|
||||
list_for_each_safe(plist_head, plist_next,
|
||||
peasycap->purb_video_head) {
|
||||
pdata_urb = list_entry(plist_head,
|
||||
struct data_urb, list_head);
|
||||
if (pdata_urb) {
|
||||
peasycap->allocation_video_struct -=
|
||||
sizeof(struct data_urb);
|
||||
kfree(pdata_urb);
|
||||
m++;
|
||||
}
|
||||
}
|
||||
JOM(4, "%i video data_urb structures freed\n", m);
|
||||
JOM(4, "setting peasycap->purb_video_head=NULL\n");
|
||||
peasycap->purb_video_head = NULL;
|
||||
}
|
||||
|
||||
/* Free video isoc buffers */
|
||||
JOM(4, "freeing video isoc buffers.\n");
|
||||
m = 0;
|
||||
for (k = 0; k < VIDEO_ISOC_BUFFER_MANY; k++) {
|
||||
if (peasycap->video_isoc_buffer[k].pgo) {
|
||||
free_pages((unsigned long)
|
||||
peasycap->video_isoc_buffer[k].pgo,
|
||||
VIDEO_ISOC_ORDER);
|
||||
peasycap->video_isoc_buffer[k].pgo = NULL;
|
||||
peasycap->allocation_video_page -=
|
||||
BIT(VIDEO_ISOC_ORDER);
|
||||
m++;
|
||||
}
|
||||
}
|
||||
JOM(4, "isoc video buffers freed: %i pages\n",
|
||||
m * (0x01 << VIDEO_ISOC_ORDER));
|
||||
/* Free video field buffers */
|
||||
JOM(4, "freeing video field buffers.\n");
|
||||
gone = 0;
|
||||
for (k = 0; k < FIELD_BUFFER_MANY; k++) {
|
||||
for (m = 0; m < FIELD_BUFFER_SIZE/PAGE_SIZE; m++) {
|
||||
if (peasycap->field_buffer[k][m].pgo) {
|
||||
free_page((unsigned long)
|
||||
peasycap->field_buffer[k][m].pgo);
|
||||
peasycap->field_buffer[k][m].pgo = NULL;
|
||||
peasycap->allocation_video_page -= 1;
|
||||
gone++;
|
||||
}
|
||||
}
|
||||
}
|
||||
JOM(4, "video field buffers freed: %i pages\n", gone);
|
||||
|
||||
/* Free video frame buffers */
|
||||
JOM(4, "freeing video frame buffers.\n");
|
||||
gone = 0;
|
||||
for (k = 0; k < FRAME_BUFFER_MANY; k++) {
|
||||
for (m = 0; m < FRAME_BUFFER_SIZE/PAGE_SIZE; m++) {
|
||||
if (peasycap->frame_buffer[k][m].pgo) {
|
||||
free_page((unsigned long)
|
||||
peasycap->frame_buffer[k][m].pgo);
|
||||
peasycap->frame_buffer[k][m].pgo = NULL;
|
||||
peasycap->allocation_video_page -= 1;
|
||||
gone++;
|
||||
}
|
||||
}
|
||||
}
|
||||
JOM(4, "video frame buffers freed: %i pages\n", gone);
|
||||
|
||||
/* Free audio urbs */
|
||||
if (peasycap->purb_audio_head) {
|
||||
JOM(4, "freeing audio urbs\n");
|
||||
m = 0;
|
||||
list_for_each(plist_head, (peasycap->purb_audio_head)) {
|
||||
pdata_urb = list_entry(plist_head,
|
||||
struct data_urb, list_head);
|
||||
if (pdata_urb && pdata_urb->purb) {
|
||||
usb_free_urb(pdata_urb->purb);
|
||||
pdata_urb->purb = NULL;
|
||||
peasycap->allocation_audio_urb--;
|
||||
m++;
|
||||
}
|
||||
}
|
||||
JOM(4, "%i audio urbs freed\n", m);
|
||||
JOM(4, "freeing audio data_urb structures.\n");
|
||||
m = 0;
|
||||
list_for_each_safe(plist_head, plist_next,
|
||||
peasycap->purb_audio_head) {
|
||||
pdata_urb = list_entry(plist_head,
|
||||
struct data_urb, list_head);
|
||||
if (pdata_urb) {
|
||||
peasycap->allocation_audio_struct -=
|
||||
sizeof(struct data_urb);
|
||||
kfree(pdata_urb);
|
||||
m++;
|
||||
}
|
||||
}
|
||||
JOM(4, "%i audio data_urb structures freed\n", m);
|
||||
JOM(4, "setting peasycap->purb_audio_head=NULL\n");
|
||||
peasycap->purb_audio_head = NULL;
|
||||
}
|
||||
|
||||
/* Free audio isoc buffers */
|
||||
JOM(4, "freeing audio isoc buffers.\n");
|
||||
m = 0;
|
||||
for (k = 0; k < AUDIO_ISOC_BUFFER_MANY; k++) {
|
||||
if (peasycap->audio_isoc_buffer[k].pgo) {
|
||||
free_pages((unsigned long)
|
||||
(peasycap->audio_isoc_buffer[k].pgo),
|
||||
AUDIO_ISOC_ORDER);
|
||||
peasycap->audio_isoc_buffer[k].pgo = NULL;
|
||||
peasycap->allocation_audio_page -=
|
||||
BIT(AUDIO_ISOC_ORDER);
|
||||
m++;
|
||||
}
|
||||
}
|
||||
JOM(4, "easyoss_delete(): isoc audio buffers freed: %i pages\n",
|
||||
m * (0x01 << AUDIO_ISOC_ORDER));
|
||||
JOM(4, "freeing easycap structure.\n");
|
||||
allocation_video_urb = peasycap->allocation_video_urb;
|
||||
allocation_video_page = peasycap->allocation_video_page;
|
||||
allocation_video_struct = peasycap->allocation_video_struct;
|
||||
registered_video = peasycap->registered_video;
|
||||
allocation_audio_urb = peasycap->allocation_audio_urb;
|
||||
allocation_audio_page = peasycap->allocation_audio_page;
|
||||
allocation_audio_struct = peasycap->allocation_audio_struct;
|
||||
registered_audio = peasycap->registered_audio;
|
||||
|
||||
if (0 <= kd && DONGLE_MANY > kd) {
|
||||
if (mutex_lock_interruptible(&mutex_dongle)) {
|
||||
SAY("ERROR: cannot down mutex_dongle\n");
|
||||
} else {
|
||||
JOM(4, "locked mutex_dongle\n");
|
||||
easycapdc60_dongle[kd].peasycap = NULL;
|
||||
mutex_unlock(&mutex_dongle);
|
||||
JOM(4, "unlocked mutex_dongle\n");
|
||||
JOT(4, " null-->dongle[%i].peasycap\n", kd);
|
||||
allocation_video_struct -= sizeof(struct easycap);
|
||||
}
|
||||
} else {
|
||||
SAY("ERROR: cannot purge dongle[].peasycap");
|
||||
}
|
||||
|
||||
kfree(peasycap);
|
||||
|
||||
SAY("%8i=video urbs after all deletions\n", allocation_video_urb);
|
||||
SAY("%8i=video pages after all deletions\n", allocation_video_page);
|
||||
SAY("%8i=video structs after all deletions\n", allocation_video_struct);
|
||||
SAY("%8i=video devices after all deletions\n", registered_video);
|
||||
SAY("%8i=audio urbs after all deletions\n", allocation_audio_urb);
|
||||
SAY("%8i=audio pages after all deletions\n", allocation_audio_page);
|
||||
SAY("%8i=audio structs after all deletions\n", allocation_audio_struct);
|
||||
SAY("%8i=audio devices after all deletions\n", registered_audio);
|
||||
|
||||
JOT(4, "ending.\n");
|
||||
return;
|
||||
}
|
||||
/*****************************************************************************/
|
||||
static unsigned int easycap_poll(struct file *file, poll_table *wait)
|
||||
{
|
||||
|
|
@ -2875,6 +2679,56 @@ static struct easycap *alloc_easycap(u8 bInterfaceNumber)
|
|||
return peasycap;
|
||||
}
|
||||
|
||||
static void free_easycap(struct easycap *peasycap)
|
||||
{
|
||||
int allocation_video_urb;
|
||||
int allocation_video_page;
|
||||
int allocation_video_struct;
|
||||
int allocation_audio_urb;
|
||||
int allocation_audio_page;
|
||||
int allocation_audio_struct;
|
||||
int registered_video, registered_audio;
|
||||
int kd;
|
||||
|
||||
JOM(4, "freeing easycap structure.\n");
|
||||
allocation_video_urb = peasycap->allocation_video_urb;
|
||||
allocation_video_page = peasycap->allocation_video_page;
|
||||
allocation_video_struct = peasycap->allocation_video_struct;
|
||||
registered_video = peasycap->registered_video;
|
||||
allocation_audio_urb = peasycap->allocation_audio_urb;
|
||||
allocation_audio_page = peasycap->allocation_audio_page;
|
||||
allocation_audio_struct = peasycap->allocation_audio_struct;
|
||||
registered_audio = peasycap->registered_audio;
|
||||
|
||||
kd = easycap_isdongle(peasycap);
|
||||
if (0 <= kd && DONGLE_MANY > kd) {
|
||||
if (mutex_lock_interruptible(&mutex_dongle)) {
|
||||
SAY("ERROR: cannot down mutex_dongle\n");
|
||||
} else {
|
||||
JOM(4, "locked mutex_dongle\n");
|
||||
easycapdc60_dongle[kd].peasycap = NULL;
|
||||
mutex_unlock(&mutex_dongle);
|
||||
JOM(4, "unlocked mutex_dongle\n");
|
||||
JOT(4, " null-->dongle[%i].peasycap\n", kd);
|
||||
allocation_video_struct -= sizeof(struct easycap);
|
||||
}
|
||||
} else {
|
||||
SAY("ERROR: cannot purge dongle[].peasycap");
|
||||
}
|
||||
|
||||
/* Free device structure */
|
||||
kfree(peasycap);
|
||||
|
||||
SAY("%8i=video urbs after all deletions\n", allocation_video_urb);
|
||||
SAY("%8i=video pages after all deletions\n", allocation_video_page);
|
||||
SAY("%8i=video structs after all deletions\n", allocation_video_struct);
|
||||
SAY("%8i=video devices after all deletions\n", registered_video);
|
||||
SAY("%8i=audio urbs after all deletions\n", allocation_audio_urb);
|
||||
SAY("%8i=audio pages after all deletions\n", allocation_audio_page);
|
||||
SAY("%8i=audio structs after all deletions\n", allocation_audio_struct);
|
||||
SAY("%8i=audio devices after all deletions\n", registered_audio);
|
||||
}
|
||||
|
||||
/*
|
||||
* FIXME: Identify the appropriate pointer peasycap for interfaces
|
||||
* 1 and 2. The address of peasycap->pusb_device is reluctantly used
|
||||
|
|
@ -3073,6 +2927,26 @@ static int alloc_framebuffers(struct easycap *peasycap)
|
|||
return 0;
|
||||
}
|
||||
|
||||
static void free_framebuffers(struct easycap *peasycap)
|
||||
{
|
||||
int k, m, gone;
|
||||
|
||||
JOM(4, "freeing video frame buffers.\n");
|
||||
gone = 0;
|
||||
for (k = 0; k < FRAME_BUFFER_MANY; k++) {
|
||||
for (m = 0; m < FRAME_BUFFER_SIZE/PAGE_SIZE; m++) {
|
||||
if (peasycap->frame_buffer[k][m].pgo) {
|
||||
free_page((unsigned long)
|
||||
peasycap->frame_buffer[k][m].pgo);
|
||||
peasycap->frame_buffer[k][m].pgo = NULL;
|
||||
peasycap->allocation_video_page -= 1;
|
||||
gone++;
|
||||
}
|
||||
}
|
||||
}
|
||||
JOM(4, "video frame buffers freed: %i pages\n", gone);
|
||||
}
|
||||
|
||||
static int alloc_fieldbuffers(struct easycap *peasycap)
|
||||
{
|
||||
int i, j;
|
||||
|
|
@ -3112,6 +2986,26 @@ static int alloc_fieldbuffers(struct easycap *peasycap)
|
|||
return 0;
|
||||
}
|
||||
|
||||
static void free_fieldbuffers(struct easycap *peasycap)
|
||||
{
|
||||
int k, m, gone;
|
||||
|
||||
JOM(4, "freeing video field buffers.\n");
|
||||
gone = 0;
|
||||
for (k = 0; k < FIELD_BUFFER_MANY; k++) {
|
||||
for (m = 0; m < FIELD_BUFFER_SIZE/PAGE_SIZE; m++) {
|
||||
if (peasycap->field_buffer[k][m].pgo) {
|
||||
free_page((unsigned long)
|
||||
peasycap->field_buffer[k][m].pgo);
|
||||
peasycap->field_buffer[k][m].pgo = NULL;
|
||||
peasycap->allocation_video_page -= 1;
|
||||
gone++;
|
||||
}
|
||||
}
|
||||
}
|
||||
JOM(4, "video field buffers freed: %i pages\n", gone);
|
||||
}
|
||||
|
||||
static int alloc_isocbuffers(struct easycap *peasycap)
|
||||
{
|
||||
int i;
|
||||
|
|
@ -3142,6 +3036,27 @@ static int alloc_isocbuffers(struct easycap *peasycap)
|
|||
return 0;
|
||||
}
|
||||
|
||||
static void free_isocbuffers(struct easycap *peasycap)
|
||||
{
|
||||
int k, m;
|
||||
|
||||
JOM(4, "freeing video isoc buffers.\n");
|
||||
m = 0;
|
||||
for (k = 0; k < VIDEO_ISOC_BUFFER_MANY; k++) {
|
||||
if (peasycap->video_isoc_buffer[k].pgo) {
|
||||
free_pages((unsigned long)
|
||||
peasycap->video_isoc_buffer[k].pgo,
|
||||
VIDEO_ISOC_ORDER);
|
||||
peasycap->video_isoc_buffer[k].pgo = NULL;
|
||||
peasycap->allocation_video_page -=
|
||||
BIT(VIDEO_ISOC_ORDER);
|
||||
m++;
|
||||
}
|
||||
}
|
||||
JOM(4, "isoc video buffers freed: %i pages\n",
|
||||
m * (0x01 << VIDEO_ISOC_ORDER));
|
||||
}
|
||||
|
||||
static int create_video_urbs(struct easycap *peasycap)
|
||||
{
|
||||
struct urb *purb;
|
||||
|
|
@ -3234,6 +3149,45 @@ static int create_video_urbs(struct easycap *peasycap)
|
|||
return 0;
|
||||
}
|
||||
|
||||
static void free_video_urbs(struct easycap *peasycap)
|
||||
{
|
||||
struct list_head *plist_head, *plist_next;
|
||||
struct data_urb *pdata_urb;
|
||||
int m;
|
||||
|
||||
if (peasycap->purb_video_head) {
|
||||
m = 0;
|
||||
list_for_each(plist_head, peasycap->purb_video_head) {
|
||||
pdata_urb = list_entry(plist_head,
|
||||
struct data_urb, list_head);
|
||||
if (pdata_urb && pdata_urb->purb) {
|
||||
usb_free_urb(pdata_urb->purb);
|
||||
pdata_urb->purb = NULL;
|
||||
peasycap->allocation_video_urb--;
|
||||
m++;
|
||||
}
|
||||
}
|
||||
|
||||
JOM(4, "%i video urbs freed\n", m);
|
||||
JOM(4, "freeing video data_urb structures.\n");
|
||||
m = 0;
|
||||
list_for_each_safe(plist_head, plist_next,
|
||||
peasycap->purb_video_head) {
|
||||
pdata_urb = list_entry(plist_head,
|
||||
struct data_urb, list_head);
|
||||
if (pdata_urb) {
|
||||
peasycap->allocation_video_struct -=
|
||||
sizeof(struct data_urb);
|
||||
kfree(pdata_urb);
|
||||
m++;
|
||||
}
|
||||
}
|
||||
JOM(4, "%i video data_urb structures freed\n", m);
|
||||
JOM(4, "setting peasycap->purb_video_head=NULL\n");
|
||||
peasycap->purb_video_head = NULL;
|
||||
}
|
||||
}
|
||||
|
||||
static int alloc_audio_buffers(struct easycap *peasycap)
|
||||
{
|
||||
void *pbuf;
|
||||
|
|
@ -3263,6 +3217,27 @@ static int alloc_audio_buffers(struct easycap *peasycap)
|
|||
return 0;
|
||||
}
|
||||
|
||||
static void free_audio_buffers(struct easycap *peasycap)
|
||||
{
|
||||
int k, m;
|
||||
|
||||
JOM(4, "freeing audio isoc buffers.\n");
|
||||
m = 0;
|
||||
for (k = 0; k < AUDIO_ISOC_BUFFER_MANY; k++) {
|
||||
if (peasycap->audio_isoc_buffer[k].pgo) {
|
||||
free_pages((unsigned long)
|
||||
(peasycap->audio_isoc_buffer[k].pgo),
|
||||
AUDIO_ISOC_ORDER);
|
||||
peasycap->audio_isoc_buffer[k].pgo = NULL;
|
||||
peasycap->allocation_audio_page -=
|
||||
BIT(AUDIO_ISOC_ORDER);
|
||||
m++;
|
||||
}
|
||||
}
|
||||
JOM(4, "easyoss_delete(): isoc audio buffers freed: %i pages\n",
|
||||
m * (0x01 << AUDIO_ISOC_ORDER));
|
||||
}
|
||||
|
||||
static int create_audio_urbs(struct easycap *peasycap)
|
||||
{
|
||||
struct urb *purb;
|
||||
|
|
@ -3351,6 +3326,45 @@ static int create_audio_urbs(struct easycap *peasycap)
|
|||
return 0;
|
||||
}
|
||||
|
||||
static void free_audio_urbs(struct easycap *peasycap)
|
||||
{
|
||||
struct list_head *plist_head, *plist_next;
|
||||
struct data_urb *pdata_urb;
|
||||
int m;
|
||||
|
||||
if (peasycap->purb_audio_head) {
|
||||
JOM(4, "freeing audio urbs\n");
|
||||
m = 0;
|
||||
list_for_each(plist_head, (peasycap->purb_audio_head)) {
|
||||
pdata_urb = list_entry(plist_head,
|
||||
struct data_urb, list_head);
|
||||
if (pdata_urb && pdata_urb->purb) {
|
||||
usb_free_urb(pdata_urb->purb);
|
||||
pdata_urb->purb = NULL;
|
||||
peasycap->allocation_audio_urb--;
|
||||
m++;
|
||||
}
|
||||
}
|
||||
JOM(4, "%i audio urbs freed\n", m);
|
||||
JOM(4, "freeing audio data_urb structures.\n");
|
||||
m = 0;
|
||||
list_for_each_safe(plist_head, plist_next,
|
||||
peasycap->purb_audio_head) {
|
||||
pdata_urb = list_entry(plist_head,
|
||||
struct data_urb, list_head);
|
||||
if (pdata_urb) {
|
||||
peasycap->allocation_audio_struct -=
|
||||
sizeof(struct data_urb);
|
||||
kfree(pdata_urb);
|
||||
m++;
|
||||
}
|
||||
}
|
||||
JOM(4, "%i audio data_urb structures freed\n", m);
|
||||
JOM(4, "setting peasycap->purb_audio_head=NULL\n");
|
||||
peasycap->purb_audio_head = NULL;
|
||||
}
|
||||
}
|
||||
|
||||
static void config_easycap(struct easycap *peasycap,
|
||||
u8 bInterfaceNumber,
|
||||
u8 bInterfaceClass,
|
||||
|
|
@ -3389,6 +3403,45 @@ static void config_easycap(struct easycap *peasycap,
|
|||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* This function is called from within easycap_usb_disconnect() and is
|
||||
* protected by semaphores set and cleared by easycap_usb_disconnect().
|
||||
* By this stage the device has already been physically unplugged,
|
||||
* so peasycap->pusb_device is no longer valid.
|
||||
*/
|
||||
static void easycap_delete(struct kref *pkref)
|
||||
{
|
||||
struct easycap *peasycap;
|
||||
|
||||
peasycap = container_of(pkref, struct easycap, kref);
|
||||
if (!peasycap) {
|
||||
SAM("ERROR: peasycap is NULL: cannot perform deletions\n");
|
||||
return;
|
||||
}
|
||||
|
||||
/* Free video urbs */
|
||||
free_video_urbs(peasycap);
|
||||
|
||||
/* Free video isoc buffers */
|
||||
free_isocbuffers(peasycap);
|
||||
|
||||
/* Free video field buffers */
|
||||
free_fieldbuffers(peasycap);
|
||||
|
||||
/* Free video frame buffers */
|
||||
free_framebuffers(peasycap);
|
||||
|
||||
/* Free audio urbs */
|
||||
free_audio_urbs(peasycap);
|
||||
|
||||
/* Free audio isoc buffers */
|
||||
free_audio_buffers(peasycap);
|
||||
|
||||
free_easycap(peasycap);
|
||||
|
||||
JOT(4, "ending.\n");
|
||||
}
|
||||
|
||||
static const struct v4l2_file_operations v4l2_fops = {
|
||||
.owner = THIS_MODULE,
|
||||
.open = easycap_open_noinode,
|
||||
|
|
|
|||
Загрузка…
Ссылка в новой задаче