main.c 9.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473
  1. #include <u.h>
  2. #include <libc.h>
  3. #include <bio.h>
  4. #include "pci.h"
  5. #include "vga.h"
  6. Biobuf stdout;
  7. static int iflag, lflag, pflag, rflag;
  8. static char *usage =
  9. "usage: aux/vga [ -BcdilpvV ] [ -b bios-id ] [ -m monitor ] [ -x db ] [ mode [ virtualsize ] ]\n";
  10. static char *dbname = "/lib/vgadb";
  11. static char monitordb[128];
  12. static void
  13. dump(Vga* vga)
  14. {
  15. Ctlr *ctlr;
  16. Attr *attr;
  17. if(vga->mode)
  18. dbdumpmode(vga->mode);
  19. for(attr = vga->attr; attr; attr = attr->next)
  20. Bprint(&stdout, "vga->attr: %s=%s\n", attr->attr, attr->val);
  21. for(ctlr = vga->link; ctlr; ctlr = ctlr->link){
  22. if(ctlr->dump == 0)
  23. continue;
  24. trace("%s->dump\n", ctlr->name);
  25. if(ctlr->flag && ctlr->flag != Fsnarf){
  26. printitem(ctlr->name, "flag");
  27. printflag(ctlr->flag);
  28. Bprint(&stdout, "\n");
  29. }
  30. (*ctlr->dump)(vga, ctlr);
  31. ctlr->flag |= Fdump;
  32. }
  33. Bprint(&stdout, "\n");
  34. }
  35. void
  36. resyncinit(Vga* vga, Ctlr* ctlr, ulong on, ulong off)
  37. {
  38. Ctlr *link;
  39. trace("%s->resyncinit on 0x%8.8luX off 0x%8.8luX\n",
  40. ctlr->name, on, off);
  41. for(link = vga->link; link; link = link->link){
  42. link->flag |= on;
  43. link->flag &= ~off;
  44. if(link == ctlr)
  45. continue;
  46. if(link->init == 0 || (link->flag & Finit) == 0)
  47. continue;
  48. link->flag &= ~Finit;
  49. trace("%s->init 0x%8.8luX\n", link->name, link->flag);
  50. (*link->init)(vga, link);
  51. }
  52. }
  53. void
  54. sequencer(Vga* vga, int on)
  55. {
  56. static uchar seq01;
  57. static int state = 1;
  58. char *s;
  59. if(on)
  60. s = "on";
  61. else
  62. s = "off";
  63. trace("sequencer->enter %s\n", s);
  64. if(on){
  65. if(vga)
  66. seq01 = vga->sequencer[0x01];
  67. if(state == 0){
  68. seq01 |= 0x01;
  69. vgaxo(Seqx, 0x01, seq01);
  70. vgaxo(Seqx, 0x00, 0x03);
  71. }
  72. }
  73. else{
  74. vgaxo(Seqx, 0x00, 0x01);
  75. seq01 = vgaxi(Seqx, 0x01);
  76. vgaxo(Seqx, 0x01, seq01|0x20);
  77. }
  78. state = on;
  79. trace("sequencer->leave %s\n", s);
  80. }
  81. static void
  82. linear(Vga* vga)
  83. {
  84. char buf[256];
  85. char *p;
  86. /*
  87. * Set up for linear addressing: try to allocate the
  88. * kernel memory map then read the base-address back.
  89. * vga->linear is a compatibility hack.
  90. */
  91. if(vga->linear == 0){
  92. vga->ctlr->flag &= ~Ulinear;
  93. return;
  94. }
  95. if(vga->ctlr->flag & Ulinear){
  96. /*
  97. * If there's already an aperture don't bother trying
  98. * to set up a new one.
  99. */
  100. vgactlr("addr", buf);
  101. if(atoi(buf)==0 && (buf[0]!='p' || buf[1]!=' ' || atoi(buf+2)==0)){
  102. sprint(buf, "0x%lux 0x%lux", vga->apz ? vga->apz : vga->vmz, vga->vma);
  103. vgactlw("linear", buf);
  104. vgactlr("addr", buf);
  105. }
  106. trace("linear->addr %s\n", buf);
  107. /*
  108. * old: addr 0x12345678
  109. * new: addr p 0x12345678 v 0x82345678 size 0x123
  110. */
  111. if(buf[0]=='p' && buf[1]==' '){
  112. vga->vmb = strtoul(buf+2, 0, 0);
  113. p = strstr(buf, "size");
  114. if(p)
  115. vga->apz = strtoul(p+4, 0, 0);
  116. }else
  117. vga->vmb = strtoul(buf, 0, 0);
  118. }
  119. else
  120. vgactlw("linear", "0");
  121. }
  122. char*
  123. chanstr[32+1] = {
  124. [1] "k1",
  125. [2] "k2",
  126. [4] "k4",
  127. [8] "m8",
  128. [16] "r5g6b5",
  129. [24] "r8g8b8",
  130. [32] "x8r8g8b8",
  131. };
  132. void
  133. main(int argc, char** argv)
  134. {
  135. char *bios, buf[256], sizeb[256], *p, *vsize, *psize;
  136. char *type, *vtype;
  137. int virtual, len;
  138. Ctlr *ctlr;
  139. Vga *vga;
  140. Binit(&stdout, 1, OWRITE);
  141. bios = getenv("vgactlr");
  142. if((type = getenv("monitor")) == 0)
  143. type = "vga";
  144. psize = vsize = "640x480x8";
  145. ARGBEGIN{
  146. case 'b':
  147. bios = ARGF();
  148. break;
  149. case 'B':
  150. dumpbios(0x10000);
  151. exits(0);
  152. case 'c':
  153. cflag = 1;
  154. break;
  155. case 'd':
  156. dflag = 1;
  157. break;
  158. case 'i':
  159. iflag = 1;
  160. break;
  161. case 'l':
  162. lflag = 1;
  163. break;
  164. case 'm':
  165. type = ARGF();
  166. break;
  167. case 'p':
  168. pflag = 1;
  169. break;
  170. case 'r':
  171. /*
  172. * rflag > 1 means "leave me alone, I know what I'm doing."
  173. */
  174. rflag++;
  175. break;
  176. case 'v':
  177. vflag = 1;
  178. break;
  179. case 'V':
  180. vflag = 1;
  181. Vflag = 1;
  182. break;
  183. case 'x':
  184. dbname = ARGF();
  185. break;
  186. default:
  187. error(usage, argv0);
  188. }ARGEND
  189. virtual = 0;
  190. switch(argc){
  191. case 1:
  192. vsize = psize = argv[0];
  193. break;
  194. case 2:
  195. psize = argv[0];
  196. vsize = argv[1];
  197. virtual = 1;
  198. break;
  199. case 0:
  200. break;
  201. default:
  202. error(usage, argv0);
  203. }
  204. if(lflag && strcmp(vsize, "text") == 0){
  205. vesatextmode();
  206. vgactlw("textmode", "");
  207. exits(0);
  208. }
  209. vga = alloc(sizeof(Vga));
  210. if(bios){
  211. if((vga->offset = strtol(bios, &p, 0)) == 0 || *p++ != '=')
  212. error("main: bad BIOS string format - %s\n", bios);
  213. len = strlen(p);
  214. vga->bios = alloc(len+1);
  215. strncpy(vga->bios, p, len);
  216. trace("main->BIOS %s\n", bios);
  217. }
  218. /*
  219. * Try to identify the VGA card and grab
  220. * registers. Print them out if requested.
  221. */
  222. if(strcmp(type, "vesa") == 0
  223. || dbctlr(dbname, vga) == 0 || vga->ctlr == 0)
  224. if(dbvesa(vga) == 0 || vga->ctlr == 0){
  225. Bprint(&stdout, "%s: controller not in %s, not vesa\n", argv0, dbname);
  226. dumpbios(256);
  227. type = "vga";
  228. vsize = psize = "640x480x1";
  229. virtual = 0;
  230. vga->ctlr = &generic;
  231. vga->link = &generic;
  232. }
  233. trace("main->snarf\n");
  234. for(ctlr = vga->link; ctlr; ctlr = ctlr->link){
  235. if(ctlr->snarf == 0)
  236. continue;
  237. trace("%s->snarf\n", ctlr->name);
  238. (*ctlr->snarf)(vga, ctlr);
  239. }
  240. if(pflag)
  241. dump(vga);
  242. for(ctlr = vga->link; ctlr; ctlr = ctlr->link)
  243. if(ctlr->flag & Ferror)
  244. error("%r");
  245. if(iflag || lflag){
  246. if(getenv(type))
  247. sprint(monitordb, "/env/%s", type);
  248. else
  249. strcpy(monitordb, dbname);
  250. if(vga->vesa){
  251. strcpy(monitordb, "vesa bios");
  252. vga->mode = dbvesamode(psize);
  253. }else
  254. vga->mode = dbmode(monitordb, type, psize);
  255. if(vga->mode == 0)
  256. error("main: %s@%s not in %s\n", type, psize, monitordb);
  257. if(virtual){
  258. if((p = strchr(vsize, 'x')) == nil)
  259. error("bad virtual size %s\n", vsize);
  260. vga->virtx = atoi(vsize);
  261. vga->virty = atoi(p+1);
  262. if(vga->virtx < vga->mode->x || vga->virty < vga->mode->y)
  263. error("virtual size smaller than physical size\n");
  264. vga->panning = 1;
  265. }
  266. else{
  267. vga->virtx = vga->mode->x;
  268. vga->virty = vga->mode->y;
  269. vga->panning = 0;
  270. }
  271. trace("vmf %d vmdf %d vf1 %lud vbw %lud\n",
  272. vga->mode->frequency, vga->mode->deffrequency,
  273. vga->f[1], vga->mode->videobw);
  274. if(vga->mode->frequency == 0 && vga->mode->videobw != 0 && vga->f[1] != 0){
  275. /*
  276. * boost clock as much as possible subject
  277. * to video and memory bandwidth constraints
  278. */
  279. ulong bytes, freq, membw;
  280. double rr;
  281. freq = vga->mode->videobw;
  282. if(freq > vga->f[1])
  283. freq = vga->f[1];
  284. rr = (double)freq/(vga->mode->ht*vga->mode->vt);
  285. if(rr > 85.0) /* >85Hz is ridiculous */
  286. rr = 85.0;
  287. bytes = (vga->mode->x*vga->mode->y*vga->mode->z)/8;
  288. membw = rr*bytes;
  289. if(vga->membw != 0 && membw > vga->membw){
  290. membw = vga->membw;
  291. rr = (double)membw/bytes;
  292. }
  293. freq = rr*(vga->mode->ht*vga->mode->vt);
  294. vga->mode->frequency = freq;
  295. trace("using frequency %lud rr %.2f membw %lud\n",
  296. freq, rr, membw);
  297. }
  298. else if(vga->mode->frequency == 0)
  299. vga->mode->frequency = vga->mode->deffrequency;
  300. for(ctlr = vga->link; ctlr; ctlr = ctlr->link){
  301. if(ctlr->options == 0)
  302. continue;
  303. trace("%s->options\n", ctlr->name);
  304. (*ctlr->options)(vga, ctlr);
  305. }
  306. /*
  307. * skip init for vesa - vesa will do the registers for us
  308. */
  309. if(!vga->vesa)
  310. for(ctlr = vga->link; ctlr; ctlr = ctlr->link){
  311. if(ctlr->init == 0)
  312. continue;
  313. trace("%s->init\n", ctlr->name);
  314. (*ctlr->init)(vga, ctlr);
  315. }
  316. if(strcmp(vga->mode->chan, "") == 0){
  317. if(vga->mode->z < nelem(chanstr) && chanstr[vga->mode->z])
  318. strcpy(vga->mode->chan, chanstr[vga->mode->z]);
  319. else
  320. error("%s: unknown channel type to use for depth %d", vga->ctlr->name, vga->mode->z);
  321. }
  322. if(iflag || pflag)
  323. dump(vga);
  324. if(lflag){
  325. trace("main->load\n");
  326. if(vga->vmz && (vga->virtx*vga->virty*vga->mode->z)/8 > vga->vmz)
  327. error("%s: not enough video memory - %lud\n",
  328. vga->ctlr->name, vga->vmz);
  329. if(vga->ctlr->type)
  330. vtype = vga->ctlr->type;
  331. else if(p = strchr(vga->ctlr->name, '-')){
  332. strncpy(buf, vga->ctlr->name, p - vga->ctlr->name);
  333. buf[p - vga->ctlr->name] = 0;
  334. vtype = buf;
  335. }
  336. else
  337. vtype = vga->ctlr->name;
  338. vgactlw("type", vtype);
  339. /*
  340. * VESA must be set up before linear.
  341. * Set type to vesa for linear.
  342. */
  343. if(vga->vesa){
  344. vgactlw("type", vesa.name);
  345. vesa.load(vga, vga->vesa);
  346. }
  347. /*
  348. * The new draw device needs linear mode set
  349. * before size.
  350. */
  351. linear(vga);
  352. /*
  353. * Linear is over so switch to other driver for
  354. * acceleration.
  355. */
  356. if(vga->vesa)
  357. vgactlw("type", vtype);
  358. sprint(buf, "%ludx%ludx%d %s",
  359. vga->virtx, vga->virty,
  360. vga->mode->z, vga->mode->chan);
  361. if(rflag){
  362. vgactlr("size", sizeb);
  363. if(rflag < 2 && strcmp(buf, sizeb) != 0)
  364. error("bad refresh: %s != %s\n",
  365. buf, sizeb);
  366. }
  367. else
  368. vgactlw("size", buf);
  369. /*
  370. * No fiddling with registers if VESA set
  371. * things up already. Sorry.
  372. */
  373. if(!vga->vesa){
  374. /*
  375. * Turn off the display during the load.
  376. */
  377. sequencer(vga, 0);
  378. for(ctlr = vga->link; ctlr; ctlr = ctlr->link){
  379. if(ctlr->load == 0 || ctlr == &vesa)
  380. continue;
  381. trace("%s->load\n", ctlr->name);
  382. (*ctlr->load)(vga, ctlr);
  383. }
  384. sequencer(vga, 1);
  385. }
  386. vgactlw("drawinit", "");
  387. if(vga->hwgc == 0 || cflag)
  388. vgactlw("hwgc", "off");
  389. else
  390. vgactlw("hwgc", vga->hwgc->name);
  391. if(vga->virtx != vga->mode->x || vga->virty != vga->mode->y){
  392. sprint(buf, "%dx%d", vga->mode->x, vga->mode->y);
  393. vgactlw("actualsize", buf);
  394. if(vga->panning)
  395. vgactlw("panning", "on");
  396. }
  397. if(pflag)
  398. dump(vga);
  399. }
  400. }
  401. trace("main->exits\n");
  402. exits(0);
  403. }