diff options
Diffstat (limited to 'firmware/ata_idle_notify.c')
-rw-r--r-- | firmware/ata_idle_notify.c | 20 |
1 files changed, 14 insertions, 6 deletions
diff --git a/firmware/ata_idle_notify.c b/firmware/ata_idle_notify.c index 35d192bee0..ee9f3c035f 100644 --- a/firmware/ata_idle_notify.c +++ b/firmware/ata_idle_notify.c | |||
@@ -25,12 +25,20 @@ | |||
25 | #include "kernel.h" | 25 | #include "kernel.h" |
26 | #include "string.h" | 26 | #include "string.h" |
27 | 27 | ||
28 | void register_storage_idle_func(void (*function)(void *data)) | 28 | static void wrapper(unsigned short id, void *ev_data, void *user_data) |
29 | { | ||
30 | (void)id; | ||
31 | (void)ev_data; | ||
32 | void (*func)(void) = user_data; | ||
33 | func(); | ||
34 | } | ||
35 | |||
36 | void register_storage_idle_func(void (*function)(void)) | ||
29 | { | 37 | { |
30 | #if USING_STORAGE_CALLBACK | 38 | #if USING_STORAGE_CALLBACK |
31 | add_event(DISK_EVENT_SPINUP, true, function); | 39 | add_event_ex(DISK_EVENT_SPINUP, true, wrapper, function); |
32 | #else | 40 | #else |
33 | function(NULL); /* just call the function now */ | 41 | function(); /* just call the function now */ |
34 | /* this _may_ cause problems later if the calling function | 42 | /* this _may_ cause problems later if the calling function |
35 | sets a variable expecting the callback to unset it, because | 43 | sets a variable expecting the callback to unset it, because |
36 | the callback will be run before this function exits, so before the var is set */ | 44 | the callback will be run before this function exits, so before the var is set */ |
@@ -38,12 +46,12 @@ void register_storage_idle_func(void (*function)(void *data)) | |||
38 | } | 46 | } |
39 | 47 | ||
40 | #if USING_STORAGE_CALLBACK | 48 | #if USING_STORAGE_CALLBACK |
41 | void unregister_storage_idle_func(void (*func)(void *data), bool run) | 49 | void unregister_storage_idle_func(void (*func)(void), bool run) |
42 | { | 50 | { |
43 | remove_event(DISK_EVENT_SPINUP, func); | 51 | remove_event_ex(DISK_EVENT_SPINUP, wrapper, func); |
44 | 52 | ||
45 | if (run) | 53 | if (run) |
46 | func(NULL); | 54 | func(); |
47 | } | 55 | } |
48 | 56 | ||
49 | bool call_storage_idle_notifys(bool force) | 57 | bool call_storage_idle_notifys(bool force) |