git.zerfleddert.de Git - raggedstone/blame_incremental

... / ...

Commit	Line	Data
	1	#include "xparameters.h"
	2	#include "xgpio_l.h"
	3
	4	#include "stdio.h"
	5
	6	#include "xutil.h"
	7
	8	#define DISP7(a,b,c,d,e,f,g) (0\|((~(a\|b<<1\|c<<2\|d<<3\|e<<4\|f<<5\|g<<6))&0xff))
	9
	10	void display_num(unsigned short num) {
	11	unsigned int val = 0x00;
	12	int i;
	13	unsigned short digit;
	14
	15	XGpio_mSetDataDirection(XPAR_SEVENSEG_BASEADDR, 1, 0x00000000);
	16
	17	for (i=0; i<5; i++) {
	18	digit = ((num>>(4*i)) & 0xf);
	19	switch(digit) {
	20	case 0x0:
	21	val = DISP7(1,1,1,1,1,1,0);
	22	break;
	23	case 0x1:
	24	val = DISP7(0,1,1,0,0,0,0);
	25	break;
	26	case 0x2:
	27	val = DISP7(1,1,0,1,1,0,1);
	28	break;
	29	case 0x3:
	30	val = DISP7(1,1,1,1,0,0,1);
	31	break;
	32	case 0x4:
	33	val = DISP7(0,1,1,0,0,1,1);
	34	break;
	35	case 0x5:
	36	val = DISP7(1,0,1,1,0,1,1);
	37	break;
	38	case 0x6:
	39	val = DISP7(1,0,1,1,1,1,1);
	40	break;
	41	case 0x7:
	42	val = DISP7(1,1,1,0,0,0,0);
	43	break;
	44	case 0x8:
	45	val = DISP7(1,1,1,1,1,1,1);
	46	break;
	47	case 0x9:
	48	val = DISP7(1,1,1,1,0,1,1);
	49	break;
	50	case 0xa:
	51	val = DISP7(1,1,1,0,1,1,1);
	52	break;
	53	case 0xb:
	54	val = DISP7(0,0,1,1,1,1,1);
	55	break;
	56	case 0xc:
	57	val = DISP7(1,0,0,1,1,1,0);
	58	break;
	59	case 0xd:
	60	val = DISP7(0,1,1,1,1,0,1);
	61	break;
	62	case 0xe:
	63	val = DISP7(1,0,0,1,1,1,1);
	64	break;
	65	case 0xf:
	66	val = DISP7(1,0,0,0,1,1,1);
	67	break;
	68	}
	69
	70	val \|= 1 << (8+(3-i));
	71
	72	if (i == 4)
	73	val = 0x00;
	74
	75	XGpio_mSetDataReg(XPAR_SEVENSEG_BASEADDR, 1, val);
	76	if (i != 4)
	77	for (val = 0; val < 100000; val++);
	78	}
	79	}
	80
	81	void flash_chip_erase() {
	82	volatile unsigned char flash = (volatile unsigned char)XPAR_FLASH_MEM0_BASEADDR;
	83
	84	flash[0x555] = 0xAA;
	85	flash[0xAAA] = 0x55;
	86	flash[0x555] = 0x80;
	87	flash[0x555] = 0xAA;
	88	flash[0xAAA] = 0x55;
	89	flash[0x555] = 0x10;
	90	}
	91
	92	void flash_erase_sector(unsigned int addr) {
	93	volatile unsigned char flash = (volatile unsigned char)XPAR_FLASH_MEM0_BASEADDR;
	94
	95	flash[0x555] = 0xAA;
	96	flash[0xAAA] = 0x55;
	97	flash[0x555] = 0x80;
	98	flash[0x555] = 0xAA;
	99	flash[0xAAA] = 0x55;
	100	flash[addr] = 0x30;
	101	}
	102
	103	void flash_program_byte(unsigned int addr, unsigned char value) {
	104	volatile unsigned char flash = (volatile unsigned char)XPAR_FLASH_MEM0_BASEADDR;
	105	unsigned int count = 0xffffffff;
	106
	107	if (flash[addr] != 0xff)
	108	return;
	109
	110	flash[0x555] = 0xAA;
	111	flash[0xAAA] = 0x55;
	112	flash[0x555] = 0xA0;
	113	flash[addr] = value;
	114
	115	while (flash[addr] != value && count) { count--; }
	116	}
	117
	118	void flash_identify(int enable) {
	119	volatile unsigned char flash = (volatile unsigned char)XPAR_FLASH_MEM0_BASEADDR;
	120
	121	flash[0x555] = 0xAA;
	122	flash[0xAAA] = 0x55;
	123	flash[0x555] = enable?0x90:0xF0;
	124	}
	125
	126	int main (void) {
	127	int i,a;
	128	volatile unsigned char flash = (volatile unsigned char)XPAR_FLASH_MEM0_BASEADDR;
	129
	130	XGpio_mSetDataDirection(XPAR_LEDS_BASEADDR, 1, 0x00000000);
	131	XGpio_mSetDataReg(XPAR_LEDS_BASEADDR, 1, 0x00);
	132	print("\r\nHallo Raggedstone!\r\n");
	133	for (i = 0; i < 1500000000; i++);
	134
	135	flash_identify(1);
	136	putnum(flash[0]\|flash[1]<<8\|flash[2]<<16\|flash[3]<<24);
	137	print("\r\n");
	138	flash_identify(0);
	139	putnum(flash[0]\|flash[1]<<8\|flash[2]<<16\|flash[3]<<24);
	140	print("\r\n");
	141
	142	for (i = 0; i < 1500000000; i++);
	143	i = 0;
	144	while(1) {
	145	print("Hallo Raggedstone ");
	146	display_num(i>>8);
	147	putnum(i);
	148	XGpio_mSetDataReg(XPAR_LEDS_BASEADDR, 1, (i & 0xf00)>>8);
	149	print("\r\n");
	150	if (i == 0x7ffff)
	151	i = 0;
	152	else
	153	i++;
	154	}
	155	return 0;
	156	}