openpcd/firmware/src/os/led.c @ master
1 | 32985a29 | laforge | /* LED support code for OpenPCD
|
---|---|---|---|
2 | * (C) 2006 by Harald Welte <hwelte@hmw-consulting.de>
|
||
3 | *
|
||
4 | * This program is free software; you can redistribute it and/or modify
|
||
5 | * it under the terms of the GNU General Public License as published by
|
||
6 | * the Free Software Foundation; either version 2 of the License, or
|
||
7 | * (at your option) any later version.
|
||
8 | *
|
||
9 | * This program is distributed in the hope that it will be useful,
|
||
10 | * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||
12 | * GNU General Public License for more details.
|
||
13 | *
|
||
14 | * You should have received a copy of the GNU General Public License
|
||
15 | * along with this program; if not, write to the Free Software
|
||
16 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
||
17 | *
|
||
18 | */
|
||
19 | 41333333 | (no author) | |
20 | caf50003 | (no author) | #include <sys/types.h>
|
21 | 81416e6a | (no author) | #include <errno.h>
|
22 | #include <lib_AT91SAM7.h>
|
||
23 | #include <openpcd.h>
|
||
24 | 520784c7 | (no author) | #include "../openpcd.h"
|
25 | #include <os/usb_handler.h>
|
||
26 | #include <os/req_ctx.h>
|
||
27 | #include <os/dbgu.h>
|
||
28 | 41333333 | (no author) | |
29 | 817d9211 | laforge | static const int ledport[] = { |
30 | [1] = OPENPCD_PIO_LED1, |
||
31 | [2] = OPENPCD_PIO_LED2, |
||
32 | };
|
||
33 | |||
34 | 41333333 | (no author) | void led_switch(int led, int on) |
35 | {
|
||
36 | 817d9211 | laforge | int port; |
37 | |||
38 | if (led < 1 || led > 2) |
||
39 | 41333333 | (no author) | return; |
40 | |||
41 | 817d9211 | laforge | port = ledport[led]; |
42 | 41333333 | (no author) | if (on) |
43 | AT91F_PIO_ClearOutput(AT91C_BASE_PIOA, port); |
||
44 | else
|
||
45 | AT91F_PIO_SetOutput(AT91C_BASE_PIOA, port); |
||
46 | }
|
||
47 | |||
48 | int led_get(int led) |
||
49 | {
|
||
50 | 817d9211 | laforge | int port; |
51 | 41333333 | (no author) | |
52 | 817d9211 | laforge | if (led < 1 || led > 2) |
53 | 41333333 | (no author) | return -1; |
54 | |||
55 | 817d9211 | laforge | port = ledport[led]; |
56 | |||
57 | 41333333 | (no author) | return !(AT91F_PIO_GetOutputDataStatus(AT91C_BASE_PIOA) & port); |
58 | }
|
||
59 | |||
60 | int led_toggle(int led) |
||
61 | {
|
||
62 | int on = led_get(led); |
||
63 | 817d9211 | laforge | if (on < 0) |
64 | return on; |
||
65 | 41333333 | (no author) | |
66 | 5f148f59 | (no author) | if (on) |
67 | 41333333 | (no author) | led_switch(led, 0); |
68 | 5f148f59 | (no author) | else
|
69 | 41333333 | (no author) | led_switch(led, 1); |
70 | caf50003 | (no author) | |
71 | return !on; |
||
72 | 41333333 | (no author) | }
|
73 | |||
74 | void led_init(void) |
||
75 | {
|
||
76 | caf50003 | (no author) | AT91F_PIO_CfgOutput(AT91C_BASE_PIOA, OPENPCD_PIO_LED1); |
77 | AT91F_PIO_CfgOutput(AT91C_BASE_PIOA, OPENPCD_PIO_LED2); |
||
78 | 41333333 | (no author) | led_switch(1, 0); |
79 | led_switch(2, 0); |
||
80 | }
|