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; either version 2 of the License, or
7 * (at your option) any later version.
9 * This program is distributed in the hope that it will be useful, but
10 * WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
12 * General Public License for more details.
14 * You should have received a copy of the GNU General Public License along
15 * with this program; if not, write to the Free Software Foundation, Inc.,
16 * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
20 #include <ao_seven_segment.h>
21 #include <ao_lcd_stm.h>
38 #ifndef SEVEN_SEGMENT_DEBUG
39 #define SEVEN_SEGMENT_DEBUG 0
42 static const uint8_t ao_segments[] = {
174 ao_seven_segment_direct(uint8_t digit, uint8_t segments)
178 for (s = 0; s <= 7; s++)
179 ao_lcd_set(digit, s, !!(segments & (1 << s)));
184 ao_seven_segment_set(uint8_t digit, uint8_t value)
188 if (value == AO_SEVEN_SEGMENT_CLEAR)
191 segments = ao_segments[value & 0xf];
193 /* Check for decimal point */
195 segments |= (1 << 7);
197 ao_seven_segment_direct(digit, segments);
201 ao_seven_segment_clear(void)
207 #if SEVEN_SEGMENT_DEBUG
209 ao_seven_segment_show(void)
211 uint8_t digit, value;
213 digit = ao_cmd_lex_i;
215 value = ao_cmd_lex_i;
216 ao_seven_segment_set(digit, value);
220 static const struct ao_cmds ao_seven_segment_cmds[] = {
221 { ao_seven_segment_show, "S <digit> <value>\0Set LCD digit" },
227 ao_seven_segment_init(void)
229 #if SEVEN_SEGMENT_DEBUG
230 ao_cmd_register(ao_seven_segment_cmds);