add mbox control act led

1 files changed, 44 insertions, 2 deletions

diff --git a/bsp/raspberry-pi/raspi3-64/applications/main.c b/bsp/raspberry-pi/raspi3-64/applications/main.c
index bcccbecc00..397f40126b 100644
--- a/bsp/raspberry-pi/raspi3-64/applications/main.c
+++ b/bsp/raspberry-pi/raspi3-64/applications/main.c
@@ -9,11 +9,53 @@
  */
 
 #include <rtthread.h>
+#include <rtdevice.h>
+#include <board.h>
+#include "mbox.h"
+
+void set_led(int state) //set state LED nyala atau mati
+{
+    if (state==1)                       //LED nyala
+    { 
+        mbox[0] = 8*4;                  // length of the message
+        mbox[1] = MBOX_REQUEST;         // this is a request message
+    
+        mbox[2] = 0x00038041;   // get serial number command
+        mbox[3] = 8;                    // buffer size
+        mbox[4] = 0;
+        mbox[5] = 130;                    // clear output buffer
+        mbox[6] = 1;
+        mbox[7] = MBOX_TAG_LAST;
+        mbox_call(8, MMU_DISABLE);
+    }
+    else if (state==0)                  //LED mati
+    { 
+        mbox[0] = 8*4;                  // length of the message
+        mbox[1] = MBOX_REQUEST;         // this is a request message
+    
+        mbox[2] = 0x00038041;   // get serial number command
+        mbox[3] = 8;                    // buffer size
+        mbox[4] = 0;
+        mbox[5] = 130;                    // clear output buffer
+        mbox[6] = 0;
+        mbox[7] = MBOX_TAG_LAST;
+        mbox_call(8, MMU_DISABLE);
+    }
+}
 
 int main(int argc, char** argv)
 {
+    int count = 1;
+
     rt_kprintf("Hi, this is RT-Thread!!\n");
 
-    return 0;
-}
+    while (count++)
+    {
+        set_led(1);
+        rt_thread_mdelay(500);
+        set_led(0);
+        rt_thread_mdelay(500);
+    }
 
+    return RT_EOK;
+}