2 * Copyright © 2012 Keith Packard <keithp@keithp.com>
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation; version 2 of the License.
8 * This program is distributed in the hope that it will be useful, but
9 * WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
11 * General Public License for more details.
13 * You should have received a copy of the GNU General Public License along
14 * with this program; if not, write to the Free Software Foundation, Inc.,
15 * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
19 #include <ao_seven_segment.h>
20 #include <ao_lcd_stm.h>
37 #ifndef SEVEN_SEGMENT_DEBUG
38 #define SEVEN_SEGMENT_DEBUG 0
41 static const uint8_t ao_segments[] = {
173 ao_seven_segment_direct(uint8_t digit, uint8_t segments)
177 for (s = 0; s <= 7; s++)
178 ao_lcd_set(digit, s, !!(segments & (1 << s)));
183 ao_seven_segment_set(uint8_t digit, uint8_t value)
187 if (value == AO_SEVEN_SEGMENT_CLEAR)
190 segments = ao_segments[value & 0xf];
192 /* Check for decimal point */
194 segments |= (1 << 7);
196 ao_seven_segment_direct(digit, segments);
200 ao_seven_segment_clear(void)
206 #if SEVEN_SEGMENT_DEBUG
208 ao_seven_segment_show(void)
210 uint8_t digit, value;
212 digit = ao_cmd_lex_i;
214 value = ao_cmd_lex_i;
215 ao_seven_segment_set(digit, value);
219 static const struct ao_cmds ao_seven_segment_cmds[] = {
220 { ao_seven_segment_show, "S <digit> <value>\0Set LCD digit" },
226 ao_seven_segment_init(void)
228 #if SEVEN_SEGMENT_DEBUG
229 ao_cmd_register(ao_seven_segment_cmds);