smivga.c
来自「cpc-1631的BSP包for VxWorks操作系统」· C语言 代码 · 共 1,119 行 · 第 1/3 页
C
1,119 行
0x20, 0x1F, 0x1A, 0x19, 0x0F, 0x0F, 0x0F, 0x00,
},
},
{ /* mode#6: 1024 x 768 8Bpp 60Hz*/
1024,768,8,60,
/* Init_MISC */
0xEB,
{ /* Init_SR0_SR4 */
0x03, 0x01, 0x0F, 0x03, 0x0E,
},
{ /* Init_SR10_SR24 */
0xF3, 0xB6, 0xC0, 0xDD, 0x00, 0x0E, 0x17, 0x2C,
0x99, 0x02, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00,
0xC4, 0x30, 0x02, 0x01, 0x01,
},
{ /* Init_SR30_SR75 */
0x38, 0x03, 0x20, 0x09, 0xC0, 0x3A, 0x3A, 0x3A,
0x3A, 0x3A, 0x3A, 0x3A, 0x00, 0x00, 0x03, 0xFF,
0x00, 0xFC, 0x00, 0x00, 0x20, 0x18, 0x00, 0xFC,
0x20, 0x0C, 0x44, 0x20, 0x00, 0x00, 0x00, 0x3A,
0x06, 0x68, 0xA7, 0x7F, 0x83, 0x24, 0xFF, 0x03,
0x00, 0x60, 0x59, 0x3A, 0x3A, 0x00, 0x00, 0x3A,
0x01, 0x80, 0x7E, 0x1A, 0x1A, 0x00, 0x00, 0x00,
0x50, 0x03, 0x74, 0x14, 0x3B, 0x0D, 0x09, 0x02,
0x04, 0x45, 0x30, 0x30, 0x40, 0x20,
},
{ /* Init_SR80_SR93 */
0xFF, 0x07, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0x3A,
0xF7, 0x00, 0x00, 0x00, 0xFF, 0xFF, 0x3A, 0x3A,
0x00, 0x00, 0x00, 0x00,
},
{ /* Init_SRA0_SRAF */
0x00, 0xFB, 0x9F, 0x01, 0x00, 0xED, 0xED, 0xED,
0x7B, 0xFB, 0xFF, 0xFF, 0x97, 0xEF, 0xBF, 0xDF,
},
{ /* Init_GR00_GR08 */
0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x05, 0x0F,
0xFF,
},
{ /* Init_AR00_AR14 */
0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,
0x41, 0x00, 0x0F, 0x00, 0x00,
},
{ /* Init_CR00_CR18 */
0xA3, 0x7F, 0x7F, 0x00, 0x85, 0x16, 0x24, 0xF5,
0x00, 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
0x03, 0x09, 0xFF, 0x80, 0x40, 0xFF, 0x00, 0xE3,
0xFF,
},
{ /* Init_CR30_CR4D */
0x00, 0x00, 0x00, 0x00, 0x00, 0x80, 0x02, 0x20,
0x00, 0x00, 0x00, 0x40, 0x00, 0xFF, 0xBF, 0xFF,
0xA3, 0x7F, 0x00, 0x86, 0x15, 0x24, 0xFF, 0x00,
0x01, 0x07, 0xE5, 0x20, 0x7F, 0xFF,
},
{ /* Init_CR90_CRA7 */
0x55, 0xD9, 0x5D, 0xE1, 0x86, 0x1B, 0x8E, 0x26,
0xDA, 0x8D, 0xDE, 0x94, 0x00, 0x00, 0x18, 0x00,
0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x15, 0x03,
},
},
{ /* mode#7: 1024 x 768 16Bpp 60Hz */
1024,768,16,60,
/* Init_MISC */
0xEB,
{ /* Init_SR0_SR4 */
0x03, 0x01, 0x0F, 0x03, 0x0E,
},
{ /* Init_SR10_SR24 */
0xF3, 0xB6, 0xC0, 0xDD, 0x00, 0x0E, 0x17, 0x2C,
0x99, 0x02, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00,
0xC4, 0x32, 0x02, 0x01, 0x01,
},
{ /* Init_SR30_SR75 */
0x38, 0x03, 0x20, 0x09, 0xC0, 0x3A, 0x3A, 0x3A,
0x3A, 0x3A, 0x3A, 0x3A, 0x00, 0x00, 0x03, 0xFF,
0x00, 0xFC, 0x00, 0x00, 0x20, 0x18, 0x00, 0xFC,
0x20, 0x0C, 0x44, 0x20, 0x00, 0x00, 0x00, 0x3A,
0x06, 0x68, 0xA7, 0x7F, 0x83, 0x24, 0xFF, 0x03,
0x00, 0x60, 0x59, 0x3A, 0x3A, 0x00, 0x00, 0x3A,
0x01, 0x80, 0x7E, 0x1A, 0x1A, 0x00, 0x00, 0x00,
0x50, 0x03, 0x74, 0x14, 0x3B, 0x0D, 0x09, 0x02,
0x04, 0x45, 0x30, 0x30, 0x40, 0x20,
},
{ /* Init_SR80_SR93 */
0xFF, 0x07, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0x3A,
0xF7, 0x00, 0x00, 0x00, 0xFF, 0xFF, 0x3A, 0x3A,
0x00, 0x00, 0x00, 0x00,
},
{ /* Init_SRA0_SRAF */
0x00, 0xFB, 0x9F, 0x01, 0x00, 0xED, 0xED, 0xED,
0x7B, 0xFB, 0xFF, 0xFF, 0x97, 0xEF, 0xBF, 0xDF,
},
{ /* Init_GR00_GR08 */
0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x05, 0x0F,
0xFF,
},
{ /* Init_AR00_AR14 */
0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,
0x41, 0x00, 0x0F, 0x00, 0x00,
},
{ /* Init_CR00_CR18 */
0xA3, 0x7F, 0x7F, 0x00, 0x85, 0x16, 0x24, 0xF5,
0x00, 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
0x03, 0x09, 0xFF, 0x80, 0x40, 0xFF, 0x00, 0xE3,
0xFF,
},
{ /* Init_CR30_CR4D */
0x00, 0x00, 0x00, 0x00, 0x00, 0x80, 0x02, 0x20,
0x00, 0x00, 0x00, 0x40, 0x00, 0xFF, 0xBF, 0xFF,
0xA3, 0x7F, 0x00, 0x86, 0x15, 0x24, 0xFF, 0x00,
0x01, 0x07, 0xE5, 0x20, 0x7F, 0xFF,
},
{ /* Init_CR90_CRA7 */
0x55, 0xD9, 0x5D, 0xE1, 0x86, 0x1B, 0x8E, 0x26,
0xDA, 0x8D, 0xDE, 0x94, 0x00, 0x00, 0x18, 0x00,
0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x15, 0x03,
},
},
{ /* mode#8: 1024 x 768 24Bpp 60Hz */
1024,768,24,60,
/* Init_MISC */
0xEB,
{ /* Init_SR0_SR4 */
0x03, 0x01, 0x0F, 0x03, 0x0E,
},
{ /* Init_SR10_SR24 */
0xF3, 0xB6, 0xC0, 0xDD, 0x00, 0x0E, 0x17, 0x2C,
0x99, 0x02, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00,
0xC4, 0x30, 0x02, 0x01, 0x01,
},
{ /* Init_SR30_SR75 */
0x38, 0x03, 0x20, 0x09, 0xC0, 0x3A, 0x3A, 0x3A,
0x3A, 0x3A, 0x3A, 0x3A, 0x00, 0x00, 0x03, 0xFF,
0x00, 0xFC, 0x00, 0x00, 0x20, 0x18, 0x00, 0xFC,
0x20, 0x0C, 0x44, 0x20, 0x00, 0x00, 0x00, 0x3A,
0x06, 0x68, 0xA7, 0x7F, 0x83, 0x24, 0xFF, 0x03,
0x00, 0x60, 0x59, 0x3A, 0x3A, 0x00, 0x00, 0x3A,
0x01, 0x80, 0x7E, 0x1A, 0x1A, 0x00, 0x00, 0x00,
0x50, 0x03, 0x74, 0x14, 0x3B, 0x0D, 0x09, 0x02,
0x04, 0x45, 0x30, 0x30, 0x40, 0x20,
},
{ /* Init_SR80_SR93 */
0xFF, 0x07, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0x3A,
0xF7, 0x00, 0x00, 0x00, 0xFF, 0xFF, 0x3A, 0x3A,
0x00, 0x00, 0x00, 0x00,
},
{ /* Init_SRA0_SRAF */
0x00, 0xFB, 0x9F, 0x01, 0x00, 0xED, 0xED, 0xED,
0x7B, 0xFB, 0xFF, 0xFF, 0x97, 0xEF, 0xBF, 0xDF,
},
{ /* Init_GR00_GR08 */
0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x05, 0x0F,
0xFF,
},
{ /* Init_AR00_AR14 */
0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07,
0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,
0x41, 0x00, 0x0F, 0x00, 0x00,
},
{ /* Init_CR00_CR18 */
0xA3, 0x7F, 0x7F, 0x00, 0x85, 0x16, 0x24, 0xF5,
0x00, 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
0x03, 0x09, 0xFF, 0x80, 0x40, 0xFF, 0x00, 0xE3,
0xFF,
},
{ /* Init_CR30_CR4D */
0x00, 0x00, 0x00, 0x00, 0x00, 0x80, 0x02, 0x20,
0x00, 0x00, 0x00, 0x40, 0x00, 0xFF, 0xBF, 0xFF,
0xA3, 0x7F, 0x00, 0x86, 0x15, 0x24, 0xFF, 0x00,
0x01, 0x07, 0xE5, 0x20, 0x7F, 0xFF,
},
{ /* Init_CR90_CRA7 */
0x55, 0xD9, 0x5D, 0xE1, 0x86, 0x1B, 0x8E, 0x26,
0xDA, 0x8D, 0xDE, 0x94, 0x00, 0x00, 0x18, 0x00,
0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x15, 0x03,
},
},
};
#if 0
DISPLAYMODE vesaModes[2] =
{
{640, -1, 664, 760, -1, 800, 0, 480, -1, 491, 493, -1, 525},
{800, -1, 840, 968, -1, 1056, 0, 600, -1, 601, 605, -1, 628}
};
#endif
DISPLAYMODE vesaModes[2] =
{
{640, -1, 674, 770, -1, 800, 0, 480, -1, 491, 493, -1, 525},
{800, -1, 840, 968, -1, 1056, 0, 600, -1, 601, 605, -1, 628}
};
void VgaAttributeInit(SMI_DRIVER* pDriver);
void VgaCRTCInit(SMI_DRIVER * pDriver);
void VgaGraphicsInit(SMI_DRIVER * pDriver);
void VgaSequencerInit(SMI_DRIVER * pSmiDriver);
void VgaLinuxInit(SMI_DRIVER * pDriver);
void VgaHwInit(SMI_DRIVER *pSmiDriver)
{
char tmp;
int height = pSmiDriver->generic.ugi.pMode->height;
if (height < 400)
tmp = 0xA3; /* +hsync -vsync */
else if (height < 480)
tmp = 0x63; /* -hsync +vsync */
else if (height < 768)
tmp = 0xE3; /* -hsync -vsync */
else
tmp = 0x23; /* +hsync +vsync */
sysOutByte(0xfe000000+VGA_MISC_OUT_REG, tmp);
VgaSequencerInit(pSmiDriver);
VgaGraphicsInit(pSmiDriver);
VgaAttributeInit(pSmiDriver);
/* temporary hack */
#if 0
pSmiDriver->mode = &vesaModes[0];
VgaCRTCInit(pSmiDriver);
#endif
}
/*参考linux驱动寄存器配置*/
void VgaLinuxInit(SMI_DRIVER * pDriver)
{
int i=0,j=0;
for (j=0;j < numVGAModes;j++)
{
if ((VGAMode[j].mmSizeX == pDriver->generic.ugi.pMode->width)&&
(VGAMode[j].mmSizeY == pDriver->generic.ugi.pMode->height) &&
(VGAMode[j].bpp == pDriver->generic.ugi.pMode->colorDepth))
{
for (i=0;i<SIZE_SR00_SR04;i++) /*init SEQ register SR00 - SR04*/
{
smiWriteVgaIndexed(pDriver, VGA_SEQUENCER_REG, VGA_SEQUENCER_DATA, i, VGAMode[j].Init_SR00_SR04[i]);
}
for (i=0;i<SIZE_SR10_SR24;i++) /*init SEQ register SR10 - SR24*/
{
smiWriteVgaIndexed(pDriver, VGA_SEQUENCER_REG, VGA_SEQUENCER_DATA, i+0x10, VGAMode[j].Init_SR10_SR24[i]);
}
for (i=0;i<SIZE_SR30_SR75;i++) /*init SEQ register SR30 - SR75*/
{
if (((i+0x30) != 0x62) && ((i+0x30) != 0x6a) && ((i+0x30) != 0x6b))
{
smiWriteVgaIndexed(pDriver, VGA_SEQUENCER_REG, VGA_SEQUENCER_DATA, i+0x30, VGAMode[j].Init_SR30_SR75[i]);
}
}
for (i=0;i<SIZE_SR80_SR93;i++) /*init SEQ register SR80 - SR93*/
{
smiWriteVgaIndexed(pDriver, VGA_SEQUENCER_REG, VGA_SEQUENCER_DATA, i+0x80, VGAMode[j].Init_SR80_SR93[i]);
}
for (i=0;i<SIZE_SRA0_SRAF;i++) /* init SEQ register SRA0 - SRAF*/
{
smiWriteVgaIndexed(pDriver, VGA_SEQUENCER_REG, VGA_SEQUENCER_DATA, i+0xa0, VGAMode[j].Init_SRA0_SRAF[i]);
}
for (i=0;i<SIZE_GR00_GR08;i++) /* init Graphic register GR00 - GR08*/
{
smiWriteVgaIndexed(pDriver, VGA_GRAPHICS_REG, VGA_GRAPHICS_DATA, i, VGAMode[j].Init_GR00_GR08[i]);
}
smiReadVga1(pDriver, VGA_IN_STAT1_REG); /* reset Attribute controller's flip flip */
for (i=0;i<SIZE_AR00_AR14;i++) /* init Attribute register AR00 - AR14*/
{
smiWriteVgaIndexed(pDriver, VGA_ATTRIBUTE_REG, VGA_ATTRIBUTE_REG, i, VGAMode[j].Init_AR00_AR14[i]);
}
for (i=0;i<SIZE_CR00_CR18;i++) /* init CRTC register CR00 - CR18*/
{
smiWriteVgaIndexed(pDriver, VGA_CRTC_REG, VGA_CRTC_DATA, i, VGAMode[j].Init_CR00_CR18[i]);
}
for (i=0;i<SIZE_CR30_CR4D;i++) /* init CRTC register CR30 - CR4D*/
{
smiWriteVgaIndexed(pDriver, VGA_CRTC_REG, VGA_CRTC_DATA, i+0x30, VGAMode[j].Init_CR30_CR4D[i]);
}
for (i=0;i<SIZE_CR90_CRA7;i++) /* init CRTC register CR90 - CRA7*/
{
smiWriteVgaIndexed(pDriver, VGA_CRTC_REG, VGA_CRTC_DATA, i+0x90, VGAMode[j].Init_CR90_CRA7[i]);
}
}
}
}
void VgaLinuxInitread(SMI_DRIVER * pDriver)
{
int i=0,j=0;
for (j=0;j < numVGAModes;j++)
{
if ((VGAMode[j].mmSizeX == 640)&&(VGAMode[j].mmSizeY == 480 &&VGAMode[j].bpp == 16)&&(VGAMode[j].hz == 60))
{
printf("SEQ register SR00 - SR04:\n");
for (i=0;i<SIZE_SR00_SR04;i++) /*init SEQ register SR00 - SR04*/
{
printf("index=0x%x,value=0x%x\n",i,
smiReadVgaIndexed1(pDriver, VGA_SEQUENCER_REG, VGA_SEQUENCER_DATA, i));
}
printf("SEQ register SR10 - SR24:\n");
for (i=0;i<SIZE_SR10_SR24;i++) /*init SEQ register SR10 - SR24*/
{
printf("index=0x%x,value=0x%x\n",i+0x10,
smiReadVgaIndexed1(pDriver, VGA_SEQUENCER_REG, VGA_SEQUENCER_DATA, i+0x10));
}
printf("SEQ register SR30 - SR75:\n");
for (i=0;i<SIZE_SR30_SR75;i++) /*init SEQ register SR30 - SR75*/
{
/*if (((i+0x30) != 0x62) && ((i+0x30) != 0x6a) && ((i+0x30) != 0x6b))
{*/
printf("index=0x%x,value=0x%x\n",i+0x30,
smiReadVgaIndexed1(pDriver, VGA_SEQUENCER_REG, VGA_SEQUENCER_DATA, i+0x30));
/*}*/
}
printf("SEQ register SR80 - SR93:\n");
for (i=0;i<SIZE_SR80_SR93;i++) /*init SEQ register SR80 - SR93*/
{
printf("index=0x%x,value=0x%x\n",i+0x80,
smiReadVgaIndexed1(pDriver, VGA_SEQUENCER_REG, VGA_SEQUENCER_DATA, i+0x80));
}
printf("SEQ register SRA0 - SRAF:\n");
for (i=0;i<SIZE_SRA0_SRAF;i++) /* init SEQ register SRA0 - SRAF*/
{
printf("index=0x%x,value=0x%x\n",i+0xa0,
smiReadVgaIndexed1(pDriver, VGA_SEQUENCER_REG, VGA_SEQUENCER_DATA, i+0xa0));
}
printf("Graphic register GR00 - GR08:\n");
for (i=0;i<SIZE_GR00_GR08;i++) /* init Graphic register GR00 - GR08*/
{
printf("index=0x%x,value=0x%x\n",i,
smiReadVgaIndexed1(pDriver, VGA_GRAPHICS_REG, VGA_GRAPHICS_DATA, i));
}
smiReadVga(pDriver, VGA_IN_STAT1_REG); /* reset Attribute controller's flip flip */
printf("Attribute register AR00 - AR14:\n");
for (i=0;i<SIZE_AR00_AR14;i++) /* init Attribute register AR00 - AR14*/
{
printf("index=0x%x,value=0x%x\n",i,
smiReadVgaIndexed1(pDriver, VGA_ATTRIBUTE_REG, VGA_ATTRIBUTE_REG, i));
}
printf("CRTC register CR00 - CR18:\n");
for (i=0;i<SIZE_CR00_CR18;i++) /* init CRTC register CR00 - CR18*/
{
printf("index=0x%x,value=0x%x\n",i,
smiReadVgaIndexed1(pDriver, VGA_CRTC_REG, VGA_CRTC_DATA, i));
}
printf("CRTC register CR30 - CR4D:\n");
for (i=0;i<SIZE_CR30_CR4D;i++) /* init CRTC register CR30 - CR4D*/
{
printf("index=0x%x,value=0x%x\n",i+0x30,
smiReadVgaIndexed1(pDriver, VGA_CRTC_REG, VGA_CRTC_DATA, i+0x30));
}
printf("CRTC register CR90 - CRA7:\n");
for (i=0;i<SIZE_CR90_CRA7;i++) /* init CRTC register CR90 - CRA7*/
{
printf("index=0x%x,value=0x%x\n",i+0x90,
smiReadVgaIndexed1(pDriver, VGA_CRTC_REG, VGA_CRTC_DATA, i+0x90));
}
}
}
}
⌨️ 快捷键说明
复制代码Ctrl + C
搜索代码Ctrl + F
全屏模式F11
增大字号Ctrl + =
减小字号Ctrl + -
显示快捷键?