Mercurial > louis > kiibohd-controller
annotate Scan/ISSILed/led_scan.c @ 341:66eccdd9ced5
Code cleanup
- Changing header file ifndef define to pragma once's
- Removed duplicate output_com.h's
author | Jacob Alexander <haata@kiibohd.com> |
---|---|
date | Sun, 14 Jun 2015 13:56:56 -0700 |
parents | 9e31d92caf12 |
children | 58d2c5bf95eb |
rev | line source |
---|---|
315
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
1 /* Copyright (C) 2014-2015 by Jacob Alexander |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
2 * |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
3 * This file is free software: you can redistribute it and/or modify |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
4 * it under the terms of the GNU General Public License as published by |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
5 * the Free Software Foundation, either version 3 of the License, or |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
6 * (at your option) any later version. |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
7 * |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
8 * This file is distributed in the hope that it will be useful, |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
11 * GNU General Public License for more details. |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
12 * |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
13 * You should have received a copy of the GNU General Public License |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
14 * along with this file. If not, see <http://www.gnu.org/licenses/>. |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
15 */ |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
16 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
17 // ----- Includes ----- |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
18 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
19 // Compiler Includes |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
20 #include <Lib/ScanLib.h> |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
21 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
22 // Project Includes |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
23 #include <cli.h> |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
24 #include <led.h> |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
25 #include <print.h> |
341 | 26 #include <led_conf.h> // Located with scan_loop.c |
315
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
27 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
28 // Local Includes |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
29 #include "led_scan.h" |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
30 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
31 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
32 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
33 // ----- Defines ----- |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
34 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
35 #define I2C_TxBufferLength 300 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
36 #define I2C_RxBufferLength 8 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
37 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
38 #define LED_BufferLength 144 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
39 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
40 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
41 // ----- Structs ----- |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
42 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
43 typedef struct I2C_Buffer { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
44 uint16_t head; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
45 uint16_t tail; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
46 uint8_t sequencePos; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
47 uint16_t size; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
48 uint8_t *buffer; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
49 } I2C_Buffer; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
50 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
51 typedef struct LED_Buffer { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
52 uint8_t buffer[LED_BufferLength]; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
53 } LED_Buffer; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
54 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
55 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
56 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
57 // ----- Function Declarations ----- |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
58 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
59 // CLI Functions |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
60 void cliFunc_i2cRecv( char* args ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
61 void cliFunc_i2cSend( char* args ); |
331 | 62 void cliFunc_ledPage( char* args ); |
63 void cliFunc_ledStart( char* args ); | |
315
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
64 void cliFunc_ledTest( char* args ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
65 void cliFunc_ledZero( char* args ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
66 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
67 uint8_t I2C_TxBufferPop(); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
68 void I2C_BufferPush( uint8_t byte, I2C_Buffer *buffer ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
69 uint16_t I2C_BufferLen( I2C_Buffer *buffer ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
70 uint8_t I2C_Send( uint8_t *data, uint8_t sendLen, uint8_t recvLen ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
71 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
72 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
73 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
74 // ----- Variables ----- |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
75 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
76 // Scan Module command dictionary |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
77 CLIDict_Entry( i2cRecv, "Send I2C sequence of bytes and expect a reply of 1 byte on the last sequence." NL "\t\tUse |'s to split sequences with a stop." ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
78 CLIDict_Entry( i2cSend, "Send I2C sequence of bytes. Use |'s to split sequences with a stop." ); |
331 | 79 CLIDict_Entry( ledPage, "Read the given register page." ); |
80 CLIDict_Entry( ledStart, "Disable software shutdown." ); | |
315
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
81 CLIDict_Entry( ledTest, "Test out the led pages." ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
82 CLIDict_Entry( ledZero, "Zero out LED register pages (non-configuration)." ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
83 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
84 CLIDict_Def( ledCLIDict, "ISSI LED Module Commands" ) = { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
85 CLIDict_Item( i2cRecv ), |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
86 CLIDict_Item( i2cSend ), |
331 | 87 CLIDict_Item( ledPage ), |
88 CLIDict_Item( ledStart ), | |
315
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
89 CLIDict_Item( ledTest ), |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
90 CLIDict_Item( ledZero ), |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
91 { 0, 0, 0 } // Null entry for dictionary end |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
92 }; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
93 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
94 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
95 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
96 // Before sending the sequence, I2C_TxBuffer_CurLen is assigned and as each byte is sent, it is decremented |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
97 // Once I2C_TxBuffer_CurLen reaches zero, a STOP on the I2C bus is sent |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
98 volatile uint8_t I2C_TxBufferPtr[ I2C_TxBufferLength ]; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
99 volatile uint8_t I2C_RxBufferPtr[ I2C_TxBufferLength ]; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
100 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
101 volatile I2C_Buffer I2C_TxBuffer = { 0, 0, 0, I2C_TxBufferLength, (uint8_t*)I2C_TxBufferPtr }; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
102 volatile I2C_Buffer I2C_RxBuffer = { 0, 0, 0, I2C_RxBufferLength, (uint8_t*)I2C_RxBufferPtr }; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
103 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
104 LED_Buffer LED_pageBuffer; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
105 |
331 | 106 /* |
315
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
107 // A bit mask determining which LEDs are enabled in the ISSI chip |
331 | 108 // All channel mask example |
315
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
109 // 0x00 -> 0x11 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
110 const uint8_t LED_ledEnableMask[] = { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
111 0xE8, // I2C address |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
112 0x00, // Starting register address |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
113 0xFF, 0xFF, // C1-1 -> C1-16 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
114 0xFF, 0xFF, // C2-1 -> C2-16 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
115 0xFF, 0xFF, // C3-1 -> C3-16 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
116 0xFF, 0xFF, // C4-1 -> C4-16 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
117 0xFF, 0xFF, // C5-1 -> C5-16 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
118 0xFF, 0xFF, // C6-1 -> C6-16 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
119 0xFF, 0xFF, // C7-1 -> C7-16 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
120 0xFF, 0xFF, // C8-1 -> C8-16 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
121 0xFF, 0xFF, // C9-1 -> C9-16 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
122 }; |
331 | 123 */ |
315
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
124 |
331 | 125 /* |
126 // A bit mask determining which LEDs are enabled in the ISSI chip | |
127 // Infinity ErgoDox full mask | |
128 // 0x00 -> 0x11 | |
129 const uint8_t LED_ledEnableMask[] = { | |
130 0xE8, // I2C address | |
131 0x00, // Starting register address | |
132 0xFC, 0xFC, // C1-1 -> C1-16 | |
133 0xFB, 0xFB, // C2-1 -> C2-16 | |
134 0xFF, 0xFF, // C3-1 -> C3-16 | |
135 0xFE, 0xFE, // C4-1 -> C4-16 | |
136 0x7F, 0x7F, // C5-1 -> C5-16 | |
137 0xFF, 0xFF, // C6-1 -> C6-16 | |
138 0xCF, 0xCF, // C7-1 -> C7-16 | |
139 0xC7, 0xC7, // C8-1 -> C8-16 | |
140 0x43, 0x43, // C9-1 -> C9-16 | |
141 }; | |
142 */ | |
341 | 143 |
144 /* | |
331 | 145 const uint8_t LED_ledEnableMask[] = { |
146 0xE8, // I2C address | |
147 0x00, // Starting register address | |
148 0x00, 0x00, // C1-1 -> C1-16 | |
149 //0xEC, 0xEC, // C1-1 -> C1-16 | |
150 0x00, 0x00, // C2-1 -> C2-16 | |
151 0x00, 0x00, // C3-1 -> C3-16 | |
152 0x00, 0x00, // C4-1 -> C4-16 | |
153 0x00, 0x00, // C5-1 -> C5-16 | |
154 0x00, 0x00, // C6-1 -> C6-16 | |
155 0x08, 0x08, // C7-1 -> C7-16 | |
156 0x00, 0x00, // C8-1 -> C8-16 | |
157 0x00, 0x00, // C9-1 -> C9-16 | |
158 }; | |
341 | 159 */ |
331 | 160 |
161 | |
341 | 162 /* |
331 | 163 // XXX Pre-fill example of buffers |
164 const uint8_t examplePage[] = { | |
165 0xE8, // I2C address | |
166 0x24, // Starting register address | |
167 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, // C1-1 -> C1-16 | |
168 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, // C2-1 -> C2-16 | |
169 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, // C3-1 -> C3-16 | |
170 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, // C4-1 -> C4-16 | |
171 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, // C5-1 -> C5-16 | |
172 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, // C6-1 -> C6-16 | |
173 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, // C7-1 -> C7-16 | |
174 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, // C8-1 -> C8-16 | |
175 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, // C9-1 -> C9-16 | |
176 }; | |
341 | 177 */ |
331 | 178 |
315
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
179 // XXX Pre-fill example of buffers |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
180 const uint8_t examplePage[] = { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
181 0xE8, // I2C address |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
182 0x24, // Starting register address |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
183 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F, // C1-1 -> C1-16 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
184 0x10, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16, 0x17, 0x18, 0x19, 0x1A, 0x1B, 0x1C, 0x1D, 0x1E, 0x1F, // C2-1 -> C2-16 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
185 0x20, 0x21, 0x22, 0x23, 0x24, 0x25, 0x26, 0x27, 0x28, 0x29, 0x2A, 0x2B, 0x2C, 0x2D, 0x2E, 0x2F, // C3-1 -> C3-16 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
186 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39, 0x3A, 0x3B, 0x3C, 0x3D, 0x3E, 0x3F, // C4-1 -> C4-16 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
187 0x40, 0x41, 0x42, 0x43, 0x44, 0x45, 0x46, 0x47, 0x48, 0x49, 0x4A, 0x4B, 0x4C, 0x4D, 0x4E, 0x4F, // C5-1 -> C5-16 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
188 0x50, 0x51, 0x52, 0x53, 0x54, 0x55, 0x56, 0x57, 0x58, 0x59, 0x5A, 0x5B, 0x5C, 0x5D, 0x5E, 0x5F, // C6-1 -> C6-16 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
189 0x60, 0x61, 0x62, 0x63, 0x64, 0x65, 0x66, 0x67, 0x68, 0x69, 0x6A, 0x6B, 0x6C, 0x6D, 0x6E, 0x6F, // C7-1 -> C7-16 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
190 0x70, 0x71, 0x72, 0x73, 0x74, 0x75, 0x76, 0x77, 0x78, 0x79, 0x7A, 0x7B, 0x7C, 0x7D, 0x7E, 0x7F, // C8-1 -> C8-16 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
191 0x80, 0x81, 0x82, 0x83, 0x84, 0x85, 0x86, 0x87, 0x88, 0x89, 0x8A, 0x8B, 0x8C, 0x8D, 0x8E, 0x8F, // C9-1 -> C9-16 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
192 }; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
193 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
194 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
195 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
196 // ----- Interrupt Functions ----- |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
197 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
198 void i2c0_isr() |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
199 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
200 cli(); // Disable Interrupts |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
201 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
202 uint8_t status = I2C0_S; // Read I2C Bus status |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
203 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
204 // Master Mode Transmit |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
205 if ( I2C0_C1 & I2C_C1_TX ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
206 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
207 // Check current use of the I2C bus |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
208 // Currently sending data |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
209 if ( I2C_TxBuffer.sequencePos > 0 ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
210 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
211 // Make sure slave sent an ACK |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
212 if ( status & I2C_S_RXAK ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
213 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
214 // NACK Detected, disable interrupt |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
215 erro_print("I2C NAK detected..."); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
216 I2C0_C1 = I2C_C1_IICEN; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
217 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
218 // Abort Tx Buffer |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
219 I2C_TxBuffer.head = 0; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
220 I2C_TxBuffer.tail = 0; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
221 I2C_TxBuffer.sequencePos = 0; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
222 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
223 else |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
224 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
225 // Transmit byte |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
226 I2C0_D = I2C_TxBufferPop(); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
227 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
228 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
229 // Receiving data |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
230 else if ( I2C_RxBuffer.sequencePos > 0 ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
231 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
232 // Master Receive, addr sent |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
233 if ( status & I2C_S_ARBL ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
234 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
235 // Arbitration Lost |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
236 erro_print("Arbitration lost..."); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
237 // TODO Abort Rx |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
238 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
239 I2C0_C1 = I2C_C1_IICEN; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
240 I2C0_S = I2C_S_ARBL | I2C_S_IICIF; // Clear ARBL flag and interrupt |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
241 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
242 if ( status & I2C_S_RXAK ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
243 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
244 // Slave Address NACK Detected, disable interrupt |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
245 erro_print("Slave Address I2C NAK detected..."); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
246 // TODO Abort Rx |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
247 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
248 I2C0_C1 = I2C_C1_IICEN; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
249 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
250 else |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
251 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
252 dbug_print("Attempting to read byte"); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
253 I2C0_C1 = I2C_RxBuffer.sequencePos == 1 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
254 ? I2C_C1_IICEN | I2C_C1_IICIE | I2C_C1_MST | I2C_C1_TXAK // Single byte read |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
255 : I2C_C1_IICEN | I2C_C1_IICIE | I2C_C1_MST; // Multi-byte read |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
256 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
257 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
258 else |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
259 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
260 /* |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
261 dbug_msg("STOP - "); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
262 printHex( I2C_BufferLen( (I2C_Buffer*)&I2C_TxBuffer ) ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
263 print(NL); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
264 */ |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
265 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
266 // Delay around STOP to make sure it actually happens... |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
267 delayMicroseconds( 1 ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
268 I2C0_C1 = I2C_C1_IICEN; // Send STOP |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
269 delayMicroseconds( 7 ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
270 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
271 // If there is another sequence, start sending |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
272 if ( I2C_BufferLen( (I2C_Buffer*)&I2C_TxBuffer ) < I2C_TxBuffer.size ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
273 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
274 // Clear status flags |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
275 I2C0_S = I2C_S_IICIF | I2C_S_ARBL; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
276 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
277 // Wait...till the master dies |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
278 while ( I2C0_S & I2C_S_BUSY ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
279 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
280 // Enable I2C interrupt |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
281 I2C0_C1 = I2C_C1_IICEN | I2C_C1_IICIE | I2C_C1_MST | I2C_C1_TX; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
282 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
283 // Transmit byte |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
284 I2C0_D = I2C_TxBufferPop(); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
285 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
286 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
287 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
288 // Master Mode Receive |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
289 else |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
290 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
291 // XXX Do we need to handle 2nd last byte? |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
292 //I2C0_C1 = I2C_C1_IICEN | I2C_C1_IICIE | I2C_C1_MST | I2C_C1_TXAK; // No STOP, Rx, NAK on recv |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
293 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
294 // Last byte |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
295 if ( I2C_TxBuffer.sequencePos <= 1 ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
296 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
297 // Change to Tx mode |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
298 I2C0_C1 = I2C_C1_IICEN | I2C_C1_MST | I2C_C1_TX; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
299 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
300 // Grab last byte |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
301 I2C_BufferPush( I2C0_D, (I2C_Buffer*)&I2C_RxBuffer ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
302 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
303 delayMicroseconds( 1 ); // Should be enough time before issuing the stop |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
304 I2C0_C1 = I2C_C1_IICEN; // Send STOP |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
305 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
306 else |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
307 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
308 // Retrieve data |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
309 I2C_BufferPush( I2C0_D, (I2C_Buffer*)&I2C_RxBuffer ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
310 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
311 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
312 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
313 I2C0_S = I2C_S_IICIF; // Clear interrupt |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
314 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
315 sei(); // Re-enable Interrupts |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
316 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
317 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
318 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
319 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
320 // ----- Functions ----- |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
321 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
322 inline void I2C_setup() |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
323 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
324 // Enable I2C internal clock |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
325 SIM_SCGC4 |= SIM_SCGC4_I2C0; // Bus 0 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
326 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
327 // External pull-up resistor |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
328 PORTB_PCR0 = PORT_PCR_ODE | PORT_PCR_SRE | PORT_PCR_DSE | PORT_PCR_MUX(2); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
329 PORTB_PCR1 = PORT_PCR_ODE | PORT_PCR_SRE | PORT_PCR_DSE | PORT_PCR_MUX(2); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
330 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
331 // SCL Frequency Divider |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
332 // 400kHz -> 120 (0x85) @ 48 MHz F_BUS |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
333 I2C0_F = 0x85; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
334 I2C0_FLT = 4; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
335 I2C0_C1 = I2C_C1_IICEN; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
336 I2C0_C2 = I2C_C2_HDRS; // High drive select |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
337 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
338 // Enable I2C Interrupt |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
339 NVIC_ENABLE_IRQ( IRQ_I2C0 ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
340 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
341 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
342 void LED_zeroPages( uint8_t startPage, uint8_t numPages, uint8_t startReg, uint8_t endReg ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
343 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
344 // Page Setup |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
345 uint8_t pageSetup[] = { 0xE8, 0xFD, 0x00 }; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
346 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
347 // Max length of a page + chip id + reg start |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
348 uint8_t fullPage[ 0xB4 + 2 ] = { 0 }; // Max size of page |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
349 fullPage[0] = 0xE8; // Set chip id |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
350 fullPage[1] = startReg; // Set start reg |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
351 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
352 // Iterate through given pages, zero'ing out the given register regions |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
353 for ( uint8_t page = startPage; page < startPage + numPages; page++ ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
354 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
355 // Set page |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
356 pageSetup[2] = page; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
357 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
358 // Setup page |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
359 while ( I2C_Send( pageSetup, sizeof( pageSetup ), 0 ) == 0 ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
360 delay(1); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
361 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
362 // Zero out page |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
363 while ( I2C_Send( fullPage, endReg - startReg + 2, 0 ) == 0 ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
364 delay(1); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
365 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
366 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
367 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
368 void LED_sendPage( uint8_t *buffer, uint8_t len, uint8_t page ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
369 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
370 // Page Setup |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
371 uint8_t pageSetup[] = { 0xE8, 0xFD, page }; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
372 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
373 // Setup page |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
374 while ( I2C_Send( pageSetup, sizeof( pageSetup ), 0 ) == 0 ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
375 delay(1); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
376 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
377 // Write page to I2C Tx Buffer |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
378 while ( I2C_Send( buffer, len, 0 ) == 0 ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
379 delay(1); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
380 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
381 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
382 |
331 | 383 void LED_readPage( uint8_t len, uint8_t page ) |
384 { | |
385 // Page Setup | |
386 uint8_t pageSetup[] = { 0xE8, 0xFD, page }; | |
387 | |
388 // Setup page | |
389 while ( I2C_Send( pageSetup, sizeof( pageSetup ), 0 ) == 0 ) | |
390 delay(1); | |
391 | |
392 // Register Setup | |
393 uint8_t regSetup[] = { 0xE8, 0x00 }; | |
394 | |
395 // Setup starting register | |
396 while ( I2C_Send( regSetup, sizeof( regSetup ), 0 ) == 0 ) | |
397 delay(1); | |
398 | |
399 // Register Read Command | |
400 uint8_t regReadCmd[] = { 0xE9 }; | |
401 | |
402 // Read each register in the page | |
403 for ( uint8_t reg = 0; reg < len; reg++ ) | |
404 { | |
405 // Request register data | |
406 while ( I2C_Send( regReadCmd, sizeof( regReadCmd ), 0 ) == 0 ) | |
407 delay(1); | |
408 } | |
409 } | |
410 | |
315
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
411 void LED_writeReg( uint8_t reg, uint8_t val, uint8_t page ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
412 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
413 // Page Setup |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
414 uint8_t pageSetup[] = { 0xE8, 0xFD, page }; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
415 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
416 // Reg Write Setup |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
417 uint8_t writeData[] = { 0xE8, reg, val }; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
418 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
419 // Setup page |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
420 while ( I2C_Send( pageSetup, sizeof( pageSetup ), 0 ) == 0 ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
421 delay(1); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
422 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
423 while ( I2C_Send( writeData, sizeof( writeData ), 0 ) == 0 ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
424 delay(1); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
425 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
426 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
427 // Setup |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
428 inline void LED_setup() |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
429 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
430 // Register Scan CLI dictionary |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
431 CLI_registerDictionary( ledCLIDict, ledCLIDictName ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
432 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
433 // Initialize I2C |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
434 I2C_setup(); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
435 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
436 // Zero out Frame Registers |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
437 // This needs to be done before disabling the hardware shutdown (or the leds will do undefined things) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
438 LED_zeroPages( 0x0B, 1, 0x00, 0x0C ); // Control Registers |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
439 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
440 // Disable Hardware shutdown of ISSI chip (pull high) |
341 | 441 GPIOB_PDDR |= (1<<16); |
442 PORTB_PCR16 = PORT_PCR_SRE | PORT_PCR_DSE | PORT_PCR_MUX(1); | |
443 GPIOB_PSOR |= (1<<16); | |
315
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
444 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
445 // Clear LED Pages |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
446 LED_zeroPages( 0x00, 8, 0x00, 0xB4 ); // LED Registers |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
447 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
448 // Enable LEDs based upon mask |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
449 LED_sendPage( (uint8_t*)LED_ledEnableMask, sizeof( LED_ledEnableMask ), 0 ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
450 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
451 // Disable Software shutdown of ISSI chip |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
452 LED_writeReg( 0x0A, 0x01, 0x0B ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
453 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
454 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
455 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
456 inline uint8_t I2C_BufferCopy( uint8_t *data, uint8_t sendLen, uint8_t recvLen, I2C_Buffer *buffer ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
457 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
458 uint8_t reTurn = 0; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
459 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
460 // If sendLen is greater than buffer fail right away |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
461 if ( sendLen > buffer->size ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
462 return 0; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
463 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
464 // Calculate new tail to determine if buffer has enough space |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
465 // The first element specifies the expected number of bytes from the slave (+1) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
466 // The second element in the new buffer is the length of the buffer sequence (+1) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
467 uint16_t newTail = buffer->tail + sendLen + 2; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
468 if ( newTail >= buffer->size ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
469 newTail -= buffer->size; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
470 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
471 if ( I2C_BufferLen( buffer ) < sendLen + 2 ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
472 return 0; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
473 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
474 /* |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
475 print("|"); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
476 printHex( sendLen + 2 ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
477 print("|"); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
478 printHex( *tail ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
479 print("@"); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
480 printHex( newTail ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
481 print("@"); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
482 */ |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
483 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
484 // If buffer is clean, return 1, otherwise 2 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
485 reTurn = buffer->head == buffer->tail ? 1 : 2; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
486 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
487 // Add to buffer, already know there is enough room (simplifies adding logic) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
488 uint8_t bufferHeaderPos = 0; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
489 for ( uint16_t c = 0; c < sendLen; c++ ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
490 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
491 // Add data to buffer |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
492 switch ( bufferHeaderPos ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
493 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
494 case 0: |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
495 buffer->buffer[ buffer->tail ] = recvLen; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
496 bufferHeaderPos++; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
497 c--; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
498 break; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
499 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
500 case 1: |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
501 buffer->buffer[ buffer->tail ] = sendLen; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
502 bufferHeaderPos++; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
503 c--; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
504 break; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
505 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
506 default: |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
507 buffer->buffer[ buffer->tail ] = data[ c ]; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
508 break; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
509 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
510 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
511 // Check for wrap-around case |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
512 if ( buffer->tail + 1 >= buffer->size ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
513 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
514 buffer->tail = 0; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
515 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
516 // Normal case |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
517 else |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
518 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
519 buffer->tail++; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
520 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
521 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
522 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
523 return reTurn; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
524 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
525 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
526 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
527 inline uint16_t I2C_BufferLen( I2C_Buffer *buffer ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
528 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
529 // Tail >= Head |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
530 if ( buffer->tail >= buffer->head ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
531 return buffer->head + buffer->size - buffer->tail; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
532 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
533 // Head > Tail |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
534 return buffer->head - buffer->tail; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
535 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
536 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
537 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
538 void I2C_BufferPush( uint8_t byte, I2C_Buffer *buffer ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
539 { |
331 | 540 dbug_msg("DATA: "); |
541 printHex( byte ); | |
542 | |
315
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
543 // Make sure buffer isn't full |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
544 if ( buffer->tail + 1 == buffer->head || ( buffer->head > buffer->tail && buffer->tail + 1 - buffer->size == buffer->head ) ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
545 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
546 warn_msg("I2C_BufferPush failed, buffer full: "); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
547 printHex( byte ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
548 print( NL ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
549 return; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
550 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
551 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
552 // Check for wrap-around case |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
553 if ( buffer->tail + 1 >= buffer->size ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
554 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
555 buffer->tail = 0; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
556 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
557 // Normal case |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
558 else |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
559 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
560 buffer->tail++; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
561 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
562 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
563 // Add byte to buffer |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
564 buffer->buffer[ buffer->tail ] = byte; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
565 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
566 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
567 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
568 uint8_t I2C_TxBufferPop() |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
569 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
570 // Return 0xFF if no buffer left (do not rely on this) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
571 if ( I2C_BufferLen( (I2C_Buffer*)&I2C_TxBuffer ) >= I2C_TxBuffer.size ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
572 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
573 erro_msg("No buffer to pop an entry from... "); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
574 printHex( I2C_TxBuffer.head ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
575 print(" "); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
576 printHex( I2C_TxBuffer.tail ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
577 print(" "); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
578 printHex( I2C_TxBuffer.sequencePos ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
579 print(NL); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
580 return 0xFF; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
581 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
582 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
583 // If there is currently no sequence being sent, the first entry in the RingBuffer is the length |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
584 if ( I2C_TxBuffer.sequencePos == 0 ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
585 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
586 I2C_TxBuffer.sequencePos = 0xFF; // So this doesn't become an infinite loop |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
587 I2C_RxBuffer.sequencePos = I2C_TxBufferPop(); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
588 I2C_TxBuffer.sequencePos = I2C_TxBufferPop(); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
589 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
590 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
591 uint8_t data = I2C_TxBuffer.buffer[ I2C_TxBuffer.head ]; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
592 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
593 // Prune head |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
594 I2C_TxBuffer.head++; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
595 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
596 // Wrap-around case |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
597 if ( I2C_TxBuffer.head >= I2C_TxBuffer.size ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
598 I2C_TxBuffer.head = 0; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
599 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
600 // Decrement buffer sequence (until next stop will be sent) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
601 I2C_TxBuffer.sequencePos--; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
602 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
603 /* |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
604 dbug_msg("Popping: "); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
605 printHex( data ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
606 print(" "); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
607 printHex( I2C_TxBuffer.head ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
608 print(" "); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
609 printHex( I2C_TxBuffer.tail ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
610 print(" "); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
611 printHex( I2C_TxBuffer.sequencePos ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
612 print(NL); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
613 */ |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
614 return data; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
615 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
616 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
617 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
618 uint8_t I2C_Send( uint8_t *data, uint8_t sendLen, uint8_t recvLen ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
619 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
620 // Check head and tail pointers |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
621 // If full, return 0 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
622 // If empty, start up I2C Master Tx |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
623 // If buffer is non-empty and non-full, just append to the buffer |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
624 switch ( I2C_BufferCopy( data, sendLen, recvLen, (I2C_Buffer*)&I2C_TxBuffer ) ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
625 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
626 // Not enough buffer space... |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
627 case 0: |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
628 /* |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
629 erro_msg("Not enough Tx buffer space... "); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
630 printHex( I2C_TxBuffer.head ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
631 print(":"); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
632 printHex( I2C_TxBuffer.tail ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
633 print("+"); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
634 printHex( sendLen ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
635 print("|"); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
636 printHex( I2C_TxBuffer.size ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
637 print( NL ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
638 */ |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
639 return 0; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
640 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
641 // Empty buffer, initialize I2C |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
642 case 1: |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
643 // Clear status flags |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
644 I2C0_S = I2C_S_IICIF | I2C_S_ARBL; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
645 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
646 // Check to see if we already have control of the bus |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
647 if ( I2C0_C1 & I2C_C1_MST ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
648 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
649 // Already the master (ah yeah), send a repeated start |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
650 I2C0_C1 = I2C_C1_IICEN | I2C_C1_MST | I2C_C1_RSTA | I2C_C1_TX; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
651 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
652 // Otherwise, seize control |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
653 else |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
654 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
655 // Wait...till the master dies |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
656 while ( I2C0_S & I2C_S_BUSY ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
657 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
658 // Now we're the master (ah yisss), get ready to send stuffs |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
659 I2C0_C1 = I2C_C1_IICEN | I2C_C1_MST | I2C_C1_TX; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
660 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
661 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
662 // Enable I2C interrupt |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
663 I2C0_C1 = I2C_C1_IICEN | I2C_C1_IICIE | I2C_C1_MST | I2C_C1_TX; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
664 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
665 // Depending on what type of transfer, the first byte is configured for R or W |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
666 I2C0_D = I2C_TxBufferPop(); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
667 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
668 return 1; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
669 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
670 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
671 // Dirty buffer, I2C already initialized |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
672 return 2; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
673 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
674 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
675 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
676 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
677 // LED State processing loop |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
678 inline uint8_t LED_scan() |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
679 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
680 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
681 // I2C Busy |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
682 // S & I2C_S_BUSY |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
683 //I2C_S_BUSY |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
684 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
685 return 0; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
686 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
687 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
688 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
689 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
690 // ----- CLI Command Functions ----- |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
691 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
692 void cliFunc_i2cSend( char* args ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
693 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
694 char* curArgs; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
695 char* arg1Ptr; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
696 char* arg2Ptr = args; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
697 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
698 // Buffer used after interpretting the args, will be sent to I2C functions |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
699 // NOTE: Limited to 8 bytes currently (can be increased if necessary |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
700 #define i2cSend_BuffLenMax 8 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
701 uint8_t buffer[ i2cSend_BuffLenMax ]; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
702 uint8_t bufferLen = 0; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
703 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
704 // No \r\n by default after the command is entered |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
705 print( NL ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
706 info_msg("Sending: "); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
707 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
708 // Parse args until a \0 is found |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
709 while ( bufferLen < i2cSend_BuffLenMax ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
710 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
711 curArgs = arg2Ptr; // Use the previous 2nd arg pointer to separate the next arg from the list |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
712 CLI_argumentIsolation( curArgs, &arg1Ptr, &arg2Ptr ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
713 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
714 // Stop processing args if no more are found |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
715 if ( *arg1Ptr == '\0' ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
716 break; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
717 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
718 // If | is found, end sequence and start new one |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
719 if ( *arg1Ptr == '|' ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
720 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
721 print("| "); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
722 I2C_Send( buffer, bufferLen, 0 ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
723 bufferLen = 0; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
724 continue; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
725 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
726 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
727 // Interpret the argument |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
728 buffer[ bufferLen++ ] = (uint8_t)numToInt( arg1Ptr ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
729 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
730 // Print out the arg |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
731 dPrint( arg1Ptr ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
732 print(" "); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
733 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
734 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
735 print( NL ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
736 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
737 I2C_Send( buffer, bufferLen, 0 ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
738 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
739 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
740 void cliFunc_i2cRecv( char* args ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
741 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
742 char* curArgs; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
743 char* arg1Ptr; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
744 char* arg2Ptr = args; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
745 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
746 // Buffer used after interpretting the args, will be sent to I2C functions |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
747 // NOTE: Limited to 8 bytes currently (can be increased if necessary |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
748 #define i2cSend_BuffLenMax 8 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
749 uint8_t buffer[ i2cSend_BuffLenMax ]; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
750 uint8_t bufferLen = 0; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
751 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
752 // No \r\n by default after the command is entered |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
753 print( NL ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
754 info_msg("Sending: "); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
755 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
756 // Parse args until a \0 is found |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
757 while ( bufferLen < i2cSend_BuffLenMax ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
758 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
759 curArgs = arg2Ptr; // Use the previous 2nd arg pointer to separate the next arg from the list |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
760 CLI_argumentIsolation( curArgs, &arg1Ptr, &arg2Ptr ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
761 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
762 // Stop processing args if no more are found |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
763 if ( *arg1Ptr == '\0' ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
764 break; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
765 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
766 // If | is found, end sequence and start new one |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
767 if ( *arg1Ptr == '|' ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
768 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
769 print("| "); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
770 I2C_Send( buffer, bufferLen, 0 ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
771 bufferLen = 0; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
772 continue; |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
773 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
774 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
775 // Interpret the argument |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
776 buffer[ bufferLen++ ] = (uint8_t)numToInt( arg1Ptr ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
777 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
778 // Print out the arg |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
779 dPrint( arg1Ptr ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
780 print(" "); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
781 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
782 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
783 print( NL ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
784 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
785 I2C_Send( buffer, bufferLen, 1 ); // Only 1 byte is ever read at a time with the ISSI chip |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
786 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
787 |
331 | 788 void cliFunc_ledPage( char* args ) |
789 { | |
790 // Parse number from argument | |
791 // NOTE: Only first argument is used | |
792 char* arg1Ptr; | |
793 char* arg2Ptr; | |
794 CLI_argumentIsolation( args, &arg1Ptr, &arg2Ptr ); | |
795 | |
796 // Default to 0 if no argument is given | |
797 uint8_t page = 0; | |
798 | |
799 if ( arg1Ptr[0] != '\0' ) | |
800 { | |
801 page = (uint8_t)numToInt( arg1Ptr ); | |
802 } | |
803 | |
804 // No \r\n by default after the command is entered | |
805 print( NL ); | |
806 | |
807 LED_readPage( 0xB4, page ); | |
808 } | |
809 | |
810 void cliFunc_ledStart( char* args ) | |
811 { | |
812 print( NL ); // No \r\n by default after the command is entered | |
813 LED_zeroPages( 0x0B, 1, 0x00, 0x0C ); // Control Registers | |
814 //LED_zeroPages( 0x00, 8, 0x00, 0xB4 ); // LED Registers | |
815 LED_writeReg( 0x0A, 0x01, 0x0B ); | |
816 LED_sendPage( (uint8_t*)LED_ledEnableMask, sizeof( LED_ledEnableMask ), 0 ); | |
817 | |
818 } | |
819 | |
315
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
820 void cliFunc_ledTest( char* args ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
821 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
822 print( NL ); // No \r\n by default after the command is entered |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
823 LED_sendPage( (uint8_t*)examplePage, sizeof( examplePage ), 0 ); |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
824 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
825 |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
826 void cliFunc_ledZero( char* args ) |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
827 { |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
828 print( NL ); // No \r\n by default after the command is entered |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
829 LED_zeroPages( 0x00, 8, 0x24, 0xB4 ); // Only PWMs |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
830 } |
bcdc04cb8e2e
Initial LED support for ISSI IS31FL3731C
Jacob Alexander <haata@kiibohd.com>
parents:
diff
changeset
|
831 |