[rtems commit] bsp/gen5200: Use busy wait

[Sebastian Huber]

Module:    rtems
Branch:    master
Commit:    aa11df6e89ae807e377c760c2b5117738e1bdbdb
Changeset: http://git.rtems.org/rtems/commit/?id=aa11df6e89ae807e377c760c2b5117738e1bdbdb

Author:    Sebastian Huber <sebastian.huber at embedded-brains.de>
Date:      Thu Mar 28 09:25:07 2013 +0100

bsp/gen5200: Use busy wait

The usage of rtems_task_wake_after() is invalid during the
driver initialization.

---

 c/src/lib/libbsp/powerpc/gen5200/ide/ata.c     |    7 +++++--
 c/src/lib/libbsp/powerpc/gen5200/include/ata.h |    2 +-
 2 files changed, 6 insertions(+), 3 deletions(-)

diff --git a/c/src/lib/libbsp/powerpc/gen5200/ide/ata.c b/c/src/lib/libbsp/powerpc/gen5200/ide/ata.c
index 8815092..2706f1d 100644
--- a/c/src/lib/libbsp/powerpc/gen5200/ide/ata.c
+++ b/c/src/lib/libbsp/powerpc/gen5200/ide/ata.c
@@ -19,6 +19,8 @@
 #include <bsp.h>
 #include <bsp/mpc5200.h>
 
+#include <libcpu/powerpc-utility.h>
+
 bool ata_execute_io_command(uint8_t command, uint32_t lba, uint32_t sector_count_32)
 {
   assert(sector_count_32 >= 1);
@@ -68,10 +70,11 @@ bool ata_execute_io_command(uint8_t command, uint32_t lba, uint32_t sector_count
 
 void ata_reset_device(void)
 {
+  /* ATA/ATAPI-7 V2, 11.2 Software reset protocol */
   ATA->write.control = DCTRL_SRST;
-  rtems_task_wake_after(1);
+  rtems_bsp_delay(5);
   ATA->write.control = 0;
-  rtems_task_wake_after(RTEMS_MILLISECONDS_TO_TICKS(2));
+  rtems_bsp_delay(2000);
   ata_wait_for_not_busy();
 }
 
diff --git a/c/src/lib/libbsp/powerpc/gen5200/include/ata.h b/c/src/lib/libbsp/powerpc/gen5200/include/ata.h
index 38cd536..5693e35 100644
--- a/c/src/lib/libbsp/powerpc/gen5200/include/ata.h
+++ b/c/src/lib/libbsp/powerpc/gen5200/include/ata.h
@@ -176,7 +176,7 @@ static inline void ata_flush_sector(uint16_t *begin)
   rtems_cache_flush_multiple_data_lines(begin, ATA_SECTOR_SIZE);
 }
 
-void ata_reset_device();
+void ata_reset_device(void);
 
 bool ata_set_transfer_mode(uint8_t mode);