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