gpio test sample for edu-riscv64

2022-11-10 10:20:20 +08:00
parent b8cf052d49
commit 00b39cdd55
3 changed files with 113 additions and 8 deletions
@@ -2,9 +2,80 @@
 #include <string.h>
 #include <transform.h>

+#define BSP_LED_PIN 29
+#define BSP_KEY_PIN 31
+#define NULL_PARAMETER 0

 void  TestGpio(void)
 {
+    int pin_fd = PrivOpen(GPIO_DEV_DRIVER, O_RDWR);
+    if(pin_fd<0){
+        printf("open pin fd error:%d\n",pin_fd);
+        return;
+    }
+
+    //config led pin in board
+     struct PinParam parameter;
+     parameter.cmd = GPIO_CONFIG_MODE;
+     parameter.pin = BSP_LED_PIN;
+     parameter.mode = GPIO_CFG_OUTPUT;
+
+    struct PrivIoctlCfg ioctl_cfg;
+    ioctl_cfg.ioctl_driver_type = PIN_TYPE;
+    ioctl_cfg.args =  (void *)&parameter;
+
+    if (0 != PrivIoctl(pin_fd, OPE_CFG, &ioctl_cfg)) {
+        printf("ioctl pin fd error %d\n", pin_fd);
+        PrivClose(pin_fd);
+        return;
+    }
+
+    //config key pin in board
+     parameter.cmd = GPIO_CONFIG_MODE;
+     parameter.pin = BSP_KEY_PIN;
+     parameter.mode = GPIO_CFG_INPUT;
+
+    ioctl_cfg.ioctl_driver_type = PIN_TYPE;
+    ioctl_cfg.args =  (void *)&parameter;
+
+    if (0 != PrivIoctl(pin_fd, OPE_CFG, &ioctl_cfg)) {
+        printf("ioctl pin fd error %d\n", pin_fd);
+        PrivClose(pin_fd);
+        return;
+    } 
+
+    struct PinStat pin_led;
+    struct PinStat pin_key;
+
+    pin_led.pin = BSP_LED_PIN;
+    pin_key.pin = BSP_KEY_PIN;
    
+    //recycle read pin and write pin until key break
+    while(1){
+        if(0>PrivRead(pin_fd,&pin_key,NULL_PARAMETER)){
+            printf("read pin fd error %d\n", pin_fd);
+            PrivClose(pin_fd);
+            return;
+        }
+
+        //led on if key pressed,or led off
+        if(pin_key.val){
+            pin_led.val = GPIO_HIGH;
+            if(0>PrivWrite(pin_fd,&pin_led,NULL_PARAMETER)){
+                printf("write pin fd error %d\n", pin_fd);
+                PrivClose(pin_fd);
+                return;
+            }
+        }else{
+            pin_led.val = GPIO_LOW;
+            if(0>PrivWrite(pin_fd,&pin_led,NULL_PARAMETER)){
+                printf("write pin fd error %d\n", pin_fd);
+                PrivClose(pin_fd);
+                return;
+            }           
+        }
+
+    }
 }

+PRIV_SHELL_CMD_FUNCTION(TestGpio, a gpio test sample, PRIV_SHELL_CMD_MAIN_ATTR);