1 /*
2 * Author: Alexander Komarov <alexander.komarov@intel.com>
3 * Copyright (c) 2014 Intel Corporation.
4 *
5 * Permission is hereby granted, free of charge, to any person obtaining
6 * a copy of this software and associated documentation files (the
7 * "Software"), to deal in the Software without restriction, including
8 * without limitation the rights to use, copy, modify, merge, publish,
9 * distribute, sublicense, and/or sell copies of the Software, and to
10 * permit persons to whom the Software is furnished to do so, subject to
11 * the following conditions:
12 *
13 * The above copyright notice and this permission notice shall be
14 * included in all copies or substantial portions of the Software.
15 *
16 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
17 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
18 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
19 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
20 * LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
21 * OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
22 * WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
23 */
24
25 #include <iostream>
26 #include <string>
27 #include <stdexcept>
28 #include <unistd.h>
29 #include <stdlib.h>
30 #include <functional>
31 #include <string.h>
32 #include "lol.h"
33
34 using namespace upm;
35
36 static mraa_gpio_context *m_Ctx;
37 static unsigned char *buffer;
38
39 static mraa_gpio_context c1, c2, c3, c4;
40
41 static int charlie_pairs [12][22] = {
42 {3,124, 4,110, 5,96, 6,82, 7,68, 8,54, 9,40, 10,26, 11,12, -1,-1, -1,-1},
43 {3,122, 4,108, 5,94, 6,80, 7,66, 8,52, 9,38, 10,24, 11,10, -1,-1, -1,-1},
44 {3,120, 4,106, 5,92, 6,78, 7,64, 8,50, 9,36, 10,22, 11,8, -1,-1, -1,-1},
45 {0,125, 1,123, 2,121, 4,98, 5,84, 6,70, 7,56, 8,42, 9,28, 10,14, 11,0},
46 {0,111, 1,109, 2,107, 3,112, 5,85, 6,71, 7,57, 8,43, 9,29, 10,15, 11,1},
47 {0,97, 1,95, 2,93, 3,113, 4,99, 6,72, 7,58, 8,44, 9,30, 10,16, 11,2},
48 {0,83, 1,81, 2,79, 3,114, 4,100,5,86, 7,59, 8,45, 9,31, 10,17, 11,3},
49 {0,69, 1,67, 2,65, 3,115, 4,101,5,87, 6,73, 8,46, 9,32, 10,18, 11,4},
50 {0,55, 1,53, 2,51, 3,116, 4,102,5,88, 6,74, 7,60, 9,33, 10,19, 11,5},
51 {0,41, 1,39, 2,37, 3,117, 4,103,5,89, 6,75, 7,61, 8,47, 10,20, 11,6},
52 {0,27, 1,25, 2,23, 3,118, 4,104,5,90, 6,76, 7,62, 8,48, 9,34, 11,7},
53 {0,13, 1,11, 2,9, 3,119, 4,105,5,91, 6,77, 7,63, 8,49, 9,35, 10,21}
54 };
55
clear_gpio(int gpio)56 void clear_gpio(int gpio)
57 {
58 mraa_gpio_mode(m_Ctx[gpio], MRAA_GPIO_HIZ);
59 mraa_gpio_dir(m_Ctx[gpio], MRAA_GPIO_IN);
60 }
61
clear_prev_cycle(int cycle)62 void clear_prev_cycle(int cycle)
63 {
64 int i;
65
66 // What is prev cycle?
67 cycle--;
68 if (cycle == -1)
69 cycle = 11;
70
71 // Disable all "1"'s
72 for (i = 0; i < 11; i++) {
73 if (charlie_pairs[cycle][i*2] == -1)
74 break;
75 if(buffer[charlie_pairs[cycle][i*2 + 1]])
76 clear_gpio(charlie_pairs[cycle][i*2]);
77 }
78
79 // Disable "0"
80 clear_gpio(cycle);
81 }
82
set_strong_one(int gpio)83 void set_strong_one(int gpio)
84 {
85 mraa_gpio_dir(m_Ctx[gpio], MRAA_GPIO_OUT);
86 mraa_gpio_mode(m_Ctx[gpio], MRAA_GPIO_STRONG);
87 mraa_gpio_write(m_Ctx[gpio], 1);
88 }
89
set_strong_zero(int gpio)90 void set_strong_zero(int gpio)
91 {
92 mraa_gpio_dir(m_Ctx[gpio], MRAA_GPIO_OUT);
93 mraa_gpio_mode(m_Ctx[gpio], MRAA_GPIO_STRONG);
94 mraa_gpio_write(m_Ctx[gpio], 0);
95 }
96
97
clear_gpios()98 static void clear_gpios()
99 {
100 int i;
101 for (i = 0; i < 12; i++)
102 clear_gpio(i);
103 }
104
do_draw(void * arg)105 void *do_draw(void *arg)
106 {
107 clear_gpios();
108
109 while (1) {
110 int i, cur;
111 uint8_t cycle = 0;
112 // 12 Cycles of Matrix
113 for (cycle = 0; cycle < 12; cycle++)
114 {
115 if (cycle == 12) cycle = 0;
116
117 clear_prev_cycle(cycle);
118 // set strong/0 on current cycle line
119 set_strong_zero(cycle);
120
121 // draw ones from framebuffer
122 for (i = 0; i < 11; i++) {
123 cur = charlie_pairs[cycle][i*2];
124 if (cur == -1) break;
125
126 if (buffer[charlie_pairs[cycle][i*2 + 1]]) {
127 set_strong_one(cur);
128 // printf("cycle %d %d %d %d\n", cycle, i, charlie_pairs[cycle][i*2 + 1],
129 // buffer[charlie_pairs[cycle][i*2 + 1]]);
130 }
131 }
132 }
133
134 }
135 }
136
LoL()137 LoL::LoL() {
138 int i = 0;
139 mraa_result_t error;
140 for (i = 0; i < 12; i++)
141 {
142 if ( !(m_LoLCtx[i] = mraa_gpio_init(i+2)) )
143 {
144 throw std::invalid_argument(std::string(__FUNCTION__) +
145 ": mraa_gpio_init() failed, invalid pin?");
146 return;
147 }
148
149 }
150
151 memset(framebuffer, 0, LOL_X*LOL_Y);
152
153 // I am optimistic and stupid - thread creation
154 // always works in my world
155 buffer = (unsigned char*)framebuffer;
156 m_Ctx = m_LoLCtx;
157 pthread_create (&drawer_thread, NULL, do_draw, NULL);
158 }
159
~LoL()160 LoL::~LoL() {
161 int i = 0;
162 mraa_result_t error;
163 for (i = 0; i < 12; i++)
164 mraa_gpio_close(m_LoLCtx[i]);
165 }
166
getFramebuffer()167 unsigned char* LoL::getFramebuffer() {
168 return framebuffer;
169 }
170
setPixel(int x,int y,unsigned char pixel)171 unsigned char LoL::setPixel(int x, int y, unsigned char pixel)
172 {
173 if (x < 0 || y < 0 || x >= LOL_X || y >= LOL_Y)
174 return -1;
175
176 framebuffer[x + LOL_X*y] = (pixel == 0) ? 0 : 1;
177 return 0;
178 }
179
getPixel(int x,int y)180 unsigned char LoL::getPixel(int x, int y)
181 {
182 if (x < 0 || y < 0 || x >= LOL_X || y >= LOL_Y)
183 return -1;
184
185 return (framebuffer[x + LOL_X*y] == 0) ? 0 : 1;
186 }
187
188