1 /*
2 * Copyright (c) 2006-2021, RT-Thread Development Team
3 *
4 * SPDX-License-Identifier: Apache-2.0
5 *
6 * Change Logs:
7 * Date Author Notes
8 */
9
10 #include <rtthread.h>
11 #include "board.h"
12
13 #define RT_DEVICE_CTRL_RTC_GET_COUNT 0x81 /**< get count */
14
15 #define LED_NUM 4
16 struct fm3_gpio_ctrl
17 {
18 uint32_t led_num;
19 volatile uint32_t * PDOR;
20 volatile uint32_t * PDIR;
21 };
22
23 struct fm3_led
24 {
25 /* inherit from rt_device */
26 struct rt_device parent;
27
28 struct fm3_gpio_ctrl fm3_gpio_ctrl[LED_NUM];
29 };
30
31 static struct fm3_led fm3_led;
32
rt_led_init(rt_device_t dev)33 static rt_err_t rt_led_init (rt_device_t dev)
34 {
35 uint32_t i;
36
37 /* led0 : P54 */
38 FM3_GPIO->PFR5 &= ~((1<<7) | (1<<6) | (1<<5) |(1<<4)); /* set P54 fuction is GPIO. */
39 FM3_GPIO->DDR5 |= (1<<7) | (1<<6) | (1<<5) |(1<<4); /* set P54 output. */
40
41 /* LED0 */
42 i = 0;
43 fm3_led.fm3_gpio_ctrl[i].led_num = 4;
44 fm3_led.fm3_gpio_ctrl[i].PDOR = &FM3_GPIO->PDOR5;
45 fm3_led.fm3_gpio_ctrl[i].PDIR = &FM3_GPIO->PDIR5;
46
47 /* LED1 */
48 i++;
49 fm3_led.fm3_gpio_ctrl[i].led_num = 5;
50 fm3_led.fm3_gpio_ctrl[i].PDOR = &FM3_GPIO->PDOR5;
51 fm3_led.fm3_gpio_ctrl[i].PDIR = &FM3_GPIO->PDIR5;
52
53 /* LED2 */
54 i++;
55 fm3_led.fm3_gpio_ctrl[i].led_num = 6;
56 fm3_led.fm3_gpio_ctrl[i].PDOR = &FM3_GPIO->PDOR5;
57 fm3_led.fm3_gpio_ctrl[i].PDIR = &FM3_GPIO->PDIR5;
58
59 /* LED3 */
60 i++;
61 fm3_led.fm3_gpio_ctrl[i].led_num = 7;
62 fm3_led.fm3_gpio_ctrl[i].PDOR = &FM3_GPIO->PDOR5;
63 fm3_led.fm3_gpio_ctrl[i].PDIR = &FM3_GPIO->PDIR5;
64
65 return RT_EOK;
66 }
67
rt_led_open(rt_device_t dev,rt_uint16_t oflag)68 static rt_err_t rt_led_open(rt_device_t dev, rt_uint16_t oflag)
69 {
70 return RT_EOK;
71 }
72
rt_led_close(rt_device_t dev)73 static rt_err_t rt_led_close(rt_device_t dev)
74 {
75 return RT_EOK;
76 }
77
rt_led_read(rt_device_t dev,rt_off_t pos,void * buffer,rt_size_t size)78 static rt_ssize_t rt_led_read (rt_device_t dev, rt_off_t pos, void* buffer,
79 rt_size_t size)
80 {
81 rt_ubase_t index = 0;
82 rt_ubase_t nr = size;
83 rt_uint8_t * value = buffer;
84
85 RT_ASSERT(dev == &fm3_led.parent);
86 RT_ASSERT((pos+size) <= LED_NUM );
87
88 for(index=0; index<nr; index++)
89 {
90 if(*fm3_led.fm3_gpio_ctrl[pos+index].PDIR & 1<<fm3_led.fm3_gpio_ctrl[pos+index].led_num)
91 {
92 *value = 0;
93 }
94 else
95 {
96 *value = 1;
97 }
98 value++;
99 }
100 return index;
101 }
102
rt_led_write(rt_device_t dev,rt_off_t pos,const void * buffer,rt_size_t size)103 static rt_ssize_t rt_led_write (rt_device_t dev, rt_off_t pos,
104 const void* buffer, rt_size_t size)
105 {
106 rt_ubase_t index = 0;
107 rt_ubase_t nw = size;
108 const rt_uint8_t * value = buffer;
109
110 RT_ASSERT(dev == &fm3_led.parent);
111 RT_ASSERT((pos+size) <= LED_NUM );
112
113 for(index=0; index<nw; index++)
114 {
115 if(*value++)
116 {
117 *fm3_led.fm3_gpio_ctrl[pos+index].PDOR &= ~(1<<fm3_led.fm3_gpio_ctrl[pos+index].led_num);
118 }
119 else
120 {
121 *fm3_led.fm3_gpio_ctrl[pos+index].PDOR |= (1<<fm3_led.fm3_gpio_ctrl[pos+index].led_num);
122 }
123 }
124 return index;
125 }
126
rt_led_control(rt_device_t dev,int cmd,void * args)127 static rt_err_t rt_led_control (rt_device_t dev, int cmd, void *args)
128 {
129 RT_ASSERT(dev == &fm3_led.parent);
130
131 if(cmd == RT_DEVICE_CTRL_RTC_GET_COUNT)
132 {
133 rt_uint32_t * led_num = args;
134 *led_num = LED_NUM;
135 }
136 return RT_EOK;
137 }
138
rt_led_hw_init(void)139 void rt_led_hw_init(void)
140 {
141 fm3_led.parent.type = RT_Device_Class_Char;
142 fm3_led.parent.rx_indicate = RT_NULL;
143 fm3_led.parent.tx_complete = RT_NULL;
144 fm3_led.parent.init = rt_led_init;
145 fm3_led.parent.open = rt_led_open;
146 fm3_led.parent.close = rt_led_close;
147 fm3_led.parent.read = rt_led_read;
148 fm3_led.parent.write = rt_led_write;
149 fm3_led.parent.control = rt_led_control;
150 fm3_led.parent.user_data = RT_NULL;
151
152 /* register a character device */
153 rt_device_register(&fm3_led.parent, "led", RT_DEVICE_FLAG_RDWR);
154 /* init led device */
155 rt_led_init(&fm3_led.parent);
156 }
157
158 #ifdef RT_USING_FINSH
159 #include <finsh.h>
led(rt_uint32_t led,rt_uint32_t value)160 void led(rt_uint32_t led, rt_uint32_t value)
161 {
162 rt_uint8_t led_value = value;
163 rt_led_write(&fm3_led.parent, led, &led_value, 1);
164 }
165 FINSH_FUNCTION_EXPORT(led, e.g:led(0,100).)
166 #endif
167