libblock: Use self-contained mutex for media

Update #2843.
This commit is contained in:
Sebastian Huber
2018-01-02 16:47:14 +01:00
parent 868ca746c2
commit a59a61828b
2 changed files with 38 additions and 68 deletions

View File

@@ -324,7 +324,10 @@ typedef rtems_status_code (*rtems_media_worker)(
* @retval RTEMS_SUCCESSFUL Successful operation.
* @retval RTEMS_NO_MEMORY Not enough resources.
*/
rtems_status_code rtems_media_initialize(void);
RTEMS_INLINE_ROUTINE rtems_status_code rtems_media_initialize(void)
{
return RTEMS_SUCCESSFUL;
}
/**
* @brief Adds the @a listener with argument @a listener_arg.

View File

@@ -25,14 +25,15 @@
#include <assert.h>
#include <unistd.h>
#include <rtems/media.h>
#include <rtems.h>
#include <rtems/bdbuf.h>
#include <rtems/blkdev.h>
#include <rtems/bdpart.h>
#include <rtems/libio.h>
#include <rtems/dosfs.h>
#include <rtems/media.h>
#include <rtems/thread.h>
typedef struct {
rtems_bdpart_partition *partitions;
@@ -62,26 +63,16 @@ static RTEMS_CHAIN_DEFINE_EMPTY(listener_item_chain);
static RTEMS_CHAIN_DEFINE_EMPTY(media_item_chain);
static rtems_id media_mutex = RTEMS_ID_NONE;
static rtems_mutex media_mutex = RTEMS_MUTEX_INITIALIZER("Media");
static rtems_status_code lock(void)
static void lock(void)
{
rtems_status_code sc = RTEMS_SUCCESSFUL;
sc = rtems_semaphore_obtain(media_mutex, RTEMS_WAIT, RTEMS_NO_TIMEOUT);
if (sc != RTEMS_SUCCESSFUL) {
sc = RTEMS_NOT_CONFIGURED;
}
return sc;
rtems_mutex_lock(&media_mutex);
}
static void unlock(void)
{
rtems_status_code sc = RTEMS_SUCCESSFUL;
sc = rtems_semaphore_release(media_mutex);
assert(sc == RTEMS_SUCCESSFUL);
rtems_mutex_unlock(&media_mutex);
}
static listener_item *find_listener(
@@ -110,10 +101,11 @@ rtems_status_code rtems_media_listener_add(
)
{
rtems_status_code sc = RTEMS_SUCCESSFUL;
listener_item *item;
sc = lock();
if (sc == RTEMS_SUCCESSFUL) {
listener_item *item = find_listener(listener, listener_arg);
lock();
item = find_listener(listener, listener_arg);
if (item == NULL) {
item = malloc(sizeof(*item));
@@ -130,7 +122,6 @@ rtems_status_code rtems_media_listener_add(
}
unlock();
}
return sc;
}
@@ -141,10 +132,11 @@ rtems_status_code rtems_media_listener_remove(
)
{
rtems_status_code sc = RTEMS_SUCCESSFUL;
listener_item *item;
sc = lock();
if (sc == RTEMS_SUCCESSFUL) {
listener_item *item = find_listener(listener, listener_arg);
lock();
item = find_listener(listener, listener_arg);
if (item != NULL) {
rtems_chain_extract_unprotected(&item->node);
@@ -154,7 +146,6 @@ rtems_status_code rtems_media_listener_remove(
}
unlock();
}
return sc;
}
@@ -929,10 +920,7 @@ rtems_status_code rtems_media_post_event(
{
rtems_status_code sc = RTEMS_SUCCESSFUL;
sc = lock();
if (sc != RTEMS_SUCCESSFUL) {
return sc;
}
lock();
switch (event) {
case RTEMS_MEDIA_EVENT_DISK_ATTACH:
@@ -965,24 +953,3 @@ rtems_status_code rtems_media_post_event(
return sc;
}
rtems_status_code rtems_media_initialize(void)
{
rtems_status_code sc = RTEMS_SUCCESSFUL;
if (media_mutex == RTEMS_ID_NONE) {
sc = rtems_semaphore_create(
rtems_build_name('M', 'D', 'I', 'A'),
1,
RTEMS_LOCAL | RTEMS_PRIORITY
| RTEMS_INHERIT_PRIORITY | RTEMS_BINARY_SEMAPHORE,
0,
&media_mutex
);
if (sc != RTEMS_SUCCESSFUL) {
sc = RTEMS_NO_MEMORY;
}
}
return sc;
}