[BETA] Diskuzní fórum Elektro Bastlírny

Kód: Vybrat vše

#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <sys/io.h>

int main(int argc, char **argv) {
	int a, data1, data2, data3, data4;
	int znak[] = {12,0,6,5};	//* 2. bit je invertovanej! *//
	int port1 = 0x378;
	int port2 = 0x37A;
	char* ErrA = "\033[1;31mCHYBA: Na pozici #";
	char* ErrB = " patří číslo v rozsahu 0..255\033[00m";

	//* Zadali jsme všechny vstupní hodnoty? *//
	if (argc!=5) printf("POUŽITÍ: led74 <znak1> <znak2> <znak3> <znak4>\nnapř.: led74 1 234 56 78\n"), exit(1);

	//* Jsou vstupní data číslo (dec, hex) a v rozsahu 0..255? *//
	if (sscanf(argv[1],"%i",&data1)!=1 || (data1<0 || data1>255)) fprintf(stderr, "%s1%s\n", ErrA, ErrB), exit(1);
	if (sscanf(argv[2],"%i",&data2)!=1 || (data2<0 || data2>255)) fprintf(stderr, "%s2%s\n", ErrA, ErrB), exit(1);
	if (sscanf(argv[3],"%i",&data3)!=1 || (data3<0 || data3>255)) fprintf(stderr, "%s3%s\n", ErrA, ErrB), exit(1);
	if (sscanf(argv[4],"%i",&data4)!=1 || (data4<0 || data4>255)) fprintf(stderr, "%s4%s\n", ErrA, ErrB), exit(1);

	//* Test dostupnosti portů *//	
	if (ioperm(port1,1,1)) fprintf(stderr, "CHYBA: Nelze získat přístup na port %x\n", port1), exit(1);
	if (ioperm(port2,1,1)) fprintf(stderr, "CHYBA: Nelze získat přístup na port %x\n", port2), exit(1);

	//* Smyčka pro multiplex. 80ms cyklus (4 × 4ms × 5); frekvence znaku: ~250Hz *//
	for(a = 0; a < 5; a++) {
		//* 1. znak *//
		//* Přepni na 1.  znak a pošli mu data pro rozsvícení určitejch segmentů (třeba znak "A" =119 = 0x77 = 01110111), pak počkej 4ms *//
		outb(znak[0], port2), outb(data1, port1), usleep(4000);

		//* 2. znak *//
		outb(znak[1], port2), outb(data2, port1), usleep(4000);

		//* 3. znak *//
		outb(znak[2], port2), outb(data3, port1), usleep(4000);

		//* 4. znak *//
		outb(znak[3], port2), outb(data4, port1), usleep(4000);
	}
	return 0;
}