Fixed external LED detection
[SCSI2SD-V6.git] / software / SCSI2SD / src / led.c
1 //      Copyright (C) 2014 Michael McMaster <michael@codesrc.com>
2 //
3 //      This file is part of SCSI2SD.
4 //
5 //      SCSI2SD is free software: you can redistribute it and/or modify
6 //      it under the terms of the GNU General Public License as published by
7 //      the Free Software Foundation, either version 3 of the License, or
8 //      (at your option) any later version.
9 //
10 //      SCSI2SD is distributed in the hope that it will be useful,
11 //      but WITHOUT ANY WARRANTY; without even the implied warranty of
12 //      MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13 //      GNU General Public License for more details.
14 //
15 //      You should have received a copy of the GNU General Public License
16 //      along with SCSI2SD.  If not, see <http://www.gnu.org/licenses/>.
17
18 #include "led.h"
19
20 // External LED support only exists on the 3.5" v4 board.
21 // The powerbook v4 board ties the pin to ground.
22 // The v3 boards do not have any such pin.
23 #ifdef EXTLED_CTL
24 #define HAVE_EXTLED 1
25 #endif
26
27 #ifdef HAVE_EXTLED
28 static int enable_EXTLED = 0;
29 #endif
30
31 void ledInit()
32 {
33 #ifdef HAVE_EXTLED
34         EXTLED_SetDriveMode(EXTLED_DM_RES_UP);
35         EXTLED_Write(1); // Will pull-up through resistor.
36
37         CyDelayUs(1);
38         int val = EXTLED_Read();
39         if (val)
40         {
41                 // Pin is not tied to ground, so it's safe to use.
42                 enable_EXTLED = 1;
43                 EXTLED_SetDriveMode(LED1_DM_STRONG);
44         }
45         else
46         {
47                 // Pin is tied to ground. Using it would damage hardware
48                 // This is the case for the powerbook boards.
49                 enable_EXTLED = 0;
50                 EXTLED_SetDriveMode(EXTLED_DM_DIG_HIZ);
51
52         }
53 #endif
54         ledOff();
55 }
56
57 void ledOn()
58 {
59         LED1_Write(0);
60
61 #ifdef HAVE_EXTLED
62         if (enable_EXTLED)
63         {
64                 EXTLED_Write(1);
65         }
66 #endif
67 }
68
69 void ledOff()
70 {
71         LED1_Write(1);
72
73 #ifdef HAVE_EXTLED
74         EXTLED_Write(0);
75 #endif
76 }
77