Implement WRITE BUFFER and WRITE WITH VERIFY commands
[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 #pragma GCC push_options
18 #pragma GCC optimize("-flto")
19
20 #include "led.h"
21
22 // External LED support only exists on the 3.5" v4 board.
23 // The powerbook v4 board ties the pin to ground.
24 // The v3 boards do not have any such pin.
25 #ifdef EXTLED_CTL
26 #define HAVE_EXTLED 1
27 #endif
28
29 #ifdef HAVE_EXTLED
30 static int enable_EXTLED = 0;
31 #endif
32
33 void ledInit()
34 {
35 #ifdef HAVE_EXTLED
36         EXTLED_SetDriveMode(EXTLED_DM_RES_UP);
37         EXTLED_Write(1); // Will pull-up through resistor.
38
39         CyDelayUs(1);
40         int val = EXTLED_Read();
41         if (val)
42         {
43                 // Pin is not tied to ground, so it's safe to use.
44                 enable_EXTLED = 1;
45                 EXTLED_SetDriveMode(LED1_DM_STRONG);
46         }
47         else
48         {
49                 // Pin is tied to ground. Using it would damage hardware
50                 // This is the case for the powerbook boards.
51                 enable_EXTLED = 0;
52                 EXTLED_SetDriveMode(EXTLED_DM_DIG_HIZ);
53
54         }
55 #endif
56         ledOff();
57 }
58
59 void ledOn()
60 {
61         LED1_Write(0);
62
63 #ifdef HAVE_EXTLED
64         if (enable_EXTLED)
65         {
66                 EXTLED_Write(1);
67         }
68 #endif
69 }
70
71 void ledOff()
72 {
73         LED1_Write(1);
74
75 #ifdef HAVE_EXTLED
76         EXTLED_Write(0);
77 #endif
78 }
79
80 #pragma GCC pop_options