123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116 |
- /*
- * Copyright (C) 2023 Daniele Lacamera <root@danielinux.net>
- *
- * This program is free software: you can redistribute it and/or modify
- * it under the terms of the GNU Lesser General Public License as published by
- * the Free Software Foundation, either version 3 of the License, or
- * (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU Lesser General Public License for more details.
- *
- * You should have received a copy of the GNU Lesser General Public License
- * along with this program. If not, see <http://www.gnu.org/licenses/>.
- */
- #include <stdint.h>
- #include "led.h"
- #include "system.h"
- #include "unicore-mx/stm32/gpio.h"
- #include "unicore-mx/stm32/rcc.h"
- /* A15, G7, B4, G6, C6, C7 */
- void uled_init(void)
- {
- rcc_periph_clock_enable(RCC_GPIOA);
- rcc_periph_clock_enable(RCC_GPIOB);
- rcc_periph_clock_enable(RCC_GPIOC);
- rcc_periph_clock_enable(RCC_GPIOG);
- gpio_mode_setup(GPIOA, GPIO_MODE_OUTPUT, GPIO_PUPD_NONE, LD0);
- gpio_set(GPIOA, LD0);
- gpio_mode_setup(GPIOG, GPIO_MODE_OUTPUT, GPIO_PUPD_PULLDOWN, LD1 | LD3);
- gpio_set(GPIOG, LD1 | LD3);
- gpio_mode_setup(GPIOB, GPIO_MODE_OUTPUT, GPIO_PUPD_PULLDOWN, LD2);
- gpio_set(GPIOB, LD2);
- gpio_mode_setup(GPIOC, GPIO_MODE_OUTPUT, GPIO_PUPD_PULLDOWN, LD4 | LD5);
- gpio_set(GPIOC, LD4 | LD5);
- }
- void uled_on(int led)
- {
- switch(led)
- {
- case 0:
- gpio_set(GPIOA, LD0);
- break;
- case 1:
- gpio_set(GPIOG, LD1);
- break;
- case 2:
- gpio_set(GPIOB, LD2);
- break;
- case 3:
- gpio_set(GPIOG, LD3);
- break;
- case 4:
- gpio_set(GPIOC, LD4);
- break;
- case 5:
- gpio_set(GPIOC, LD5);
- break;
- }
- }
- void uled_off(int led)
- {
- switch(led)
- {
- case 0:
- gpio_clear(GPIOA, LD0);
- break;
- case 1:
- gpio_clear(GPIOG, LD1);
- break;
- case 2:
- gpio_clear(GPIOB, LD2);
- break;
- case 3:
- gpio_clear(GPIOG, LD3);
- break;
- case 4:
- gpio_clear(GPIOC, LD4);
- break;
- case 5:
- gpio_clear(GPIOC, LD5);
- break;
- }
- }
- void uled_bincount(uint8_t x)
- {
- int a,b,c,d;
- a = (x & 0x1);
- b = (x & 0x2) >> 1;
- c = (x & 0x4) >> 2;
- d = (x & 0x8) >> 3;
- if (a)
- gpio_set(GPIOA, LD0);
- else
- gpio_clear(GPIOA, LD0);
- if (b)
- gpio_set(GPIOG, LD1);
- else
- gpio_clear(GPIOG, LD1);
- if (c)
- gpio_set(GPIOB, LD2);
- else
- gpio_clear(GPIOB, LD2);
- if (d)
- gpio_set(GPIOG, LD3);
- else
- gpio_clear(GPIOG, LD3);
- }
|