Configuration Wizard в KEIL. Ассемблер А51, подбор битовых масок для вывода на семисегментный индикатор

#include <avr/pgmspace.h>
#include <string.h>
#include "timer.h"
#include "uart.h"
#include "disp_7seg.h"
#include "global.h"

volatile char disp_7seg_bfr[DISP7S_DIGITS];

volatile char disp_7seg_cur;

const char disp_7seg_ct[] PROGMEM = {
0x00, 0x00, 0x00, 0x00, // !"#
0x00, 0x00, 0x00, 0x00, //$%&'
DISP7S_LP, DISP7S_RP, 0x00, 0x00, //()*+
DISP7S_DOT, DISP7S_MINUS, DISP7S_DOT, DISP7S_DIV, //,-./
DISP7S_0, DISP7S_1, DISP7S_2, DISP7S_3, //0123
DISP7S_4, DISP7S_5, DISP7S_6, DISP7S_7, //4567
DISP7S_8, DISP7S_9, DISP7S_DOT, DISP7S_DOT, //89:;
0x00, 0x00, 0x00, 0x00, //<=>?
0x00, DISP7S_A, DISP7S_B, DISP7S_C, //@ABC
DISP7S_D, DISP7S_E, DISP7S_F, DISP7S_G, //DEFG
DISP7S_H, DISP7S_I, DISP7S_J, DISP7S_H, //HIJK
DISP7S_L, 0x00, 0x00, DISP7S_O, //LMNO
DISP7S_P, 0x00, 0x00, DISP7S_S, //PQRS
DISP7S_T, DISP7S_U, 0x00, 0x00, //TUVW
0x00, DISP7S_Y, DISP7S_Z, DISP7S_LP, //XYZ[
0x00, DISP7S_RP, DISP7S_UP, DISP7S_LO, //\]^_
DISP7S_UL, DISP7S_A, DISP7S_B, DISP7S_C, //`abc
DISP7S_D, DISP7S_E, DISP7S_F, DISP7S_G, //DEFG
DISP7S_H, DISP7S_I, DISP7S_J, 0x00, //HIJK
DISP7S_L, 0x00, 0x00, DISP7S_O, //LMNO
DISP7S_P, 0x00, 0x00, DISP7S_S, //PQRS
DISP7S_T, DISP7S_U, 0x00, 0x00, //TUVW
0x00, DISP7S_Y, DISP7S_Z, DISP7S_LP, //XYZ[
DISP7S_I, DISP7S_RP, DISP7S_MINUS, DISP7S_DOT //|}~.
};

#define DISP7S_D_0 0x2000
#define DISP7S_D_1 0x4000
#define DISP7S_D_2 0x8000
#define DISP7S_D_3 0x0080
#define DISP7S_D_4 0x0200
#define DISP7S_D_5 0x0400
#define DISP7S_D_6 0x0800
#define DISP7S_D_7 0x1000

const int disp_7seg_d[DISP7S_DIGITS] PROGMEM = {
	(DISP7S_D_0 ^ DISP7S_DINV), (DISP7S_D_1 ^ DISP7S_DINV),
	(DISP7S_D_2 ^ DISP7S_DINV), (DISP7S_D_3 ^ DISP7S_DINV),
	(DISP7S_D_4 ^ DISP7S_DINV), (DISP7S_D_5 ^ DISP7S_DINV),
	(DISP7S_D_6 ^ DISP7S_DINV), (DISP7S_D_7 ^ DISP7S_DINV)
};

const char disp_7seg_i[DISP7S_DIGITS] = {
	0, 0, 0, 0, 0xFF, 0xFF, 0xFF, 0xFF
};

const int disp_7seg_s[] = {
	0x0020 ^ DISP7S_SINV, 0x0040 ^ DISP7S_SINV,
	0x0080 ^ DISP7S_SINV, 0x0400 ^ DISP7S_SINV,
	0x0800 ^ DISP7S_SINV, 0x1000 ^ DISP7S_SINV,
	0x2000 ^ DISP7S_SINV, 0x4000 ^ DISP7S_SINV
};

void disp_7seg_init()
{
	disp_7seg_cur = 0;
	memset(disp_7seg_bfr, 0, DISP7S_DIGITS);
	DISP7S_SDIR0 |= (DISP7S_SMASK & 0xFF);
	DISP7S_DDIR0 |= (DISP7S_DMASK & 0xFF);
	DISP7S_SDIR1 |= (DISP7S_SMASK >> 8);
	DISP7S_DDIR1 |= (DISP7S_DMASK >> 8);
}

void disp_7seg_shift_left()
{
	memmove(disp_7seg_bfr, disp_7seg_bfr + 1, DISP7S_DIGITS);
}

void disp_7seg_shift_right()
{
	memmove(disp_7seg_bfr + 1, disp_7seg_bfr, DISP7S_DIGITS);
}

void disp_7seg_digit(char n)
{
	DISP7S_DPORT0 = (DISP7S_DPORT0 & (~( DISP7S_DMASK & 0xFF) ) ) | pgm_read_byte( (char*)(&disp_7seg_d[n]) + 0);
	DISP7S_DPORT1 = (DISP7S_DPORT1 & (~( DISP7S_DMASK >> 8  ) ) ) | pgm_read_byte( (char*)(&disp_7seg_d[n]) + 1);
}

void disp_7seg_off()
{
	DISP7S_DPORT0 = ( DISP7S_DPORT0 & ( (~DISP7S_DMASK) & 0xFF) ) | ( ( (~(DISP7S_DINV ^ DISP7S_DMASK)) & DISP7S_DMASK) & 0xFF );
	DISP7S_DPORT1 = ( DISP7S_DPORT1 & ( (~DISP7S_DMASK) >>   8) ) | ( ( (~(DISP7S_DINV ^ DISP7S_DMASK)) & DISP7S_DMASK) >>   8 );
}

void disp_7seg_segment(char s, char n)
{
	int d = 0;
	s ^= disp_7seg_i[n];
	if( s & 0x01 ) d |= disp_7seg_s[0];
	if( s & 0x02 ) d |= disp_7seg_s[1];
	if( s & 0x04 ) d |= disp_7seg_s[2];
	if( s & 0x08 ) d |= disp_7seg_s[3];
	if( s & 0x10 ) d |= disp_7seg_s[4];
	if( s & 0x20 ) d |= disp_7seg_s[5];
	if( s & 0x40 ) d |= disp_7seg_s[6];
	if( s & 0x80 ) d |= disp_7seg_s[7];
	DISP7S_SPORT0 = (DISP7S_SPORT0 & (~( DISP7S_SMASK & 0xFF) ) ) | (d & 0xFF);
	DISP7S_SPORT1 = (DISP7S_SPORT1 & (~( DISP7S_SMASK >>   8) ) ) | (d >>   8);
}

void disp_7seg_scan()
{
	char n = disp_7seg_cur;
	disp_7seg_off();
	disp_7seg_segment(disp_7seg_bfr[n], n);
	disp_7seg_digit(n);
	n ++;
	disp_7seg_cur = (n >= DISP7S_DIGITS)? 0 : n;
}

void disp_7seg_str(char *str, char i, char n)
{
	char *bfr = disp_7seg_bfr + i;
	unsigned char c;
	if( n == 0 ) n = -1;
	while(n)
	{
		c = *(str++);
		if( c == 0 ) break;
		c = pgm_read_byte( &disp_7seg_ct[ (c - 0x20) & 0x7F ] );
		if( c == DISP7S_DOT )
		{
			if( i == 0 )
			{
				*bfr = DISP7S_DOT;
				i++;
			}
			else *(bfr-1) |= DISP7S_DOT;
		}
		else
		{
			*bfr = c;
			bfr++;
			i++;
			if(i > DISP7S_DIGITS) break;
		}
		n--;
	}
}