1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
|
#include "7seg.h"
#include <stdio.h>
static device_vtable_t const seg7_vtable = {
seg7_read,
seg7_write,
seg7_deinit
};
void seg7_init( seg7_t *seg, uint16_t addr, bool initialize )
{
device_init( &seg->base, "seg7" );
seg->base.vtable = (device_vtable_t *)&seg7_vtable;
seg->addr = addr;
seg->debug = false;
if( initialize ) {
seg->latch = 0x0000;
seg->shift = 0x0000;
}
}
uint8_t seg7_read( void *obj, uint16_t addr )
{
return 0;
}
void seg7_write( void *obj, uint16_t addr, uint8_t data )
{
seg7_t *seg = (seg7_t *)obj;
switch( addr - seg->addr ) {
case DDRA:
seg->ddr = data;
break;
case PORTA:
// write bits from SER into shift register on positive SRCLK
if( ( seg->ddr | ( SRCLK & SER ) ) && ( data & SRCLK ) ) {
seg->shift = ( seg->shift << 1 ) | ( data & SER );
if( seg->debug ) {
fprintf( stderr, "7seg shifting data, data is now %02X\n", seg->shift );
}
}
// copy shift to latch register on positive RCLK
if( ( seg->ddr | RCLK ) && ( data & RCLK ) ) {
seg->latch = seg->shift;
if( seg->debug ) {
fprintf( stderr, "7seg copying %02X from shift to latch\n", seg->latch );
}
}
break;
// ignore writes to other addresses
}
}
void seg7_deinit( void *obj )
{
seg7_t *seg = (seg7_t *)obj;
device_deinit( &seg->base );
}
|