main.c 9.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476
  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. fmtinstall('H', encodefmt);
  141. Binit(&stdout, 1, OWRITE);
  142. bios = getenv("vgactlr");
  143. if((type = getenv("monitor")) == 0)
  144. type = "vga";
  145. psize = vsize = "640x480x8";
  146. ARGBEGIN{
  147. case 'b':
  148. bios = ARGF();
  149. break;
  150. case 'B':
  151. dumpbios(0x10000);
  152. exits(0);
  153. case 'c':
  154. cflag = 1;
  155. break;
  156. case 'd':
  157. dflag = 1;
  158. break;
  159. case 'i':
  160. iflag = 1;
  161. break;
  162. case 'l':
  163. lflag = 1;
  164. break;
  165. case 'm':
  166. type = ARGF();
  167. break;
  168. case 'p':
  169. pflag = 1;
  170. break;
  171. case 'r':
  172. /*
  173. * rflag > 1 means "leave me alone, I know what I'm doing."
  174. */
  175. rflag++;
  176. break;
  177. case 'v':
  178. vflag = 1;
  179. break;
  180. case 'V':
  181. vflag = 1;
  182. Vflag = 1;
  183. break;
  184. case 'x':
  185. dbname = ARGF();
  186. break;
  187. default:
  188. error(usage, argv0);
  189. }ARGEND
  190. virtual = 0;
  191. switch(argc){
  192. case 1:
  193. vsize = psize = argv[0];
  194. break;
  195. case 2:
  196. psize = argv[0];
  197. vsize = argv[1];
  198. virtual = 1;
  199. break;
  200. case 0:
  201. break;
  202. default:
  203. error(usage, argv0);
  204. }
  205. if(lflag && strcmp(vsize, "text") == 0){
  206. vesatextmode();
  207. vgactlw("textmode", "");
  208. exits(0);
  209. }
  210. vga = alloc(sizeof(Vga));
  211. if(bios){
  212. if((vga->offset = strtol(bios, &p, 0)) == 0 || *p++ != '=')
  213. error("main: bad BIOS string format - %s\n", bios);
  214. len = strlen(p);
  215. vga->bios = alloc(len+1);
  216. strncpy(vga->bios, p, len);
  217. trace("main->BIOS %s\n", bios);
  218. }
  219. /*
  220. * Try to identify the VGA card and grab
  221. * registers. Print them out if requested.
  222. */
  223. if(strcmp(type, "vesa") == 0
  224. || dbctlr(dbname, vga) == 0 || vga->ctlr == 0)
  225. if(dbvesa(vga) == 0 || vga->ctlr == 0){
  226. Bprint(&stdout, "%s: controller not in %s, not vesa\n", argv0, dbname);
  227. dumpbios(256);
  228. type = "vga";
  229. vsize = psize = "640x480x1";
  230. virtual = 0;
  231. vga->ctlr = &generic;
  232. vga->link = &generic;
  233. }
  234. trace("main->snarf\n");
  235. for(ctlr = vga->link; ctlr; ctlr = ctlr->link){
  236. if(ctlr->snarf == 0)
  237. continue;
  238. trace("%s->snarf\n", ctlr->name);
  239. (*ctlr->snarf)(vga, ctlr);
  240. }
  241. if(pflag)
  242. dump(vga);
  243. for(ctlr = vga->link; ctlr; ctlr = ctlr->link)
  244. if(ctlr->flag & Ferror)
  245. error("%r");
  246. if(iflag || lflag){
  247. if(getenv(type))
  248. snprint(monitordb, sizeof monitordb, "/env/%s", type);
  249. else
  250. strecpy(monitordb, monitordb+sizeof monitordb, dbname);
  251. if(vga->vesa){
  252. strcpy(monitordb, "vesa bios");
  253. vga->mode = dbvesamode(psize);
  254. }else
  255. vga->mode = dbmode(monitordb, type, psize);
  256. if(vga->mode == 0)
  257. error("main: %s@%s not in %s\n", type, psize, monitordb);
  258. if(virtual){
  259. if((p = strchr(vsize, 'x')) == nil)
  260. error("bad virtual size %s\n", vsize);
  261. vga->virtx = atoi(vsize);
  262. vga->virty = atoi(p+1);
  263. if(vga->virtx < vga->mode->x || vga->virty < vga->mode->y)
  264. error("virtual size smaller than physical size\n");
  265. vga->panning = 1;
  266. }
  267. else{
  268. vga->virtx = vga->mode->x;
  269. vga->virty = vga->mode->y;
  270. vga->panning = 0;
  271. }
  272. trace("vmf %d vmdf %d vf1 %lud vbw %lud\n",
  273. vga->mode->frequency, vga->mode->deffrequency,
  274. vga->f[1], vga->mode->videobw);
  275. if(vga->mode->frequency == 0 && vga->mode->videobw != 0 && vga->f[1] != 0){
  276. /*
  277. * boost clock as much as possible subject
  278. * to video and memory bandwidth constraints
  279. */
  280. ulong bytes, freq, membw;
  281. double rr;
  282. freq = vga->mode->videobw;
  283. if(freq > vga->f[1])
  284. freq = vga->f[1];
  285. rr = (double)freq/(vga->mode->ht*vga->mode->vt);
  286. if(rr > 85.0) /* >85Hz is ridiculous */
  287. rr = 85.0;
  288. bytes = (vga->mode->x*vga->mode->y*vga->mode->z)/8;
  289. membw = rr*bytes;
  290. if(vga->membw != 0 && membw > vga->membw){
  291. membw = vga->membw;
  292. rr = (double)membw/bytes;
  293. }
  294. freq = rr*(vga->mode->ht*vga->mode->vt);
  295. vga->mode->frequency = freq;
  296. trace("using frequency %lud rr %.2f membw %lud\n",
  297. freq, rr, membw);
  298. }
  299. else if(vga->mode->frequency == 0)
  300. vga->mode->frequency = vga->mode->deffrequency;
  301. for(ctlr = vga->link; ctlr; ctlr = ctlr->link){
  302. if(ctlr->options == 0)
  303. continue;
  304. trace("%s->options\n", ctlr->name);
  305. (*ctlr->options)(vga, ctlr);
  306. }
  307. /*
  308. * skip init for vesa - vesa will do the registers for us
  309. */
  310. if(!vga->vesa)
  311. for(ctlr = vga->link; ctlr; ctlr = ctlr->link){
  312. if(ctlr->init == 0)
  313. continue;
  314. trace("%s->init\n", ctlr->name);
  315. (*ctlr->init)(vga, ctlr);
  316. }
  317. if(strcmp(vga->mode->chan, "") == 0){
  318. if(vga->mode->z < nelem(chanstr) && chanstr[vga->mode->z])
  319. strcpy(vga->mode->chan, chanstr[vga->mode->z]);
  320. else
  321. error("%s: unknown channel type to use for depth %d", vga->ctlr->name, vga->mode->z);
  322. }
  323. if(iflag || pflag)
  324. dump(vga);
  325. if(lflag){
  326. trace("main->load\n");
  327. if(vga->vmz && (vga->virtx*vga->virty*vga->mode->z)/8 > vga->vmz)
  328. error("%s: not enough video memory - %lud\n",
  329. vga->ctlr->name, vga->vmz);
  330. if(vga->ctlr->type)
  331. vtype = vga->ctlr->type;
  332. else if(p = strchr(vga->ctlr->name, '-')){
  333. strncpy(buf, vga->ctlr->name, p - vga->ctlr->name);
  334. buf[p - vga->ctlr->name] = 0;
  335. vtype = buf;
  336. }
  337. else
  338. vtype = vga->ctlr->name;
  339. vgactlw("type", vtype);
  340. /*
  341. * VESA must be set up before linear.
  342. * Set type to vesa for linear.
  343. */
  344. if(vga->vesa){
  345. vesa.load(vga, vga->vesa);
  346. if(vga->vesa->flag&Ferror)
  347. error("vesa load error\n");
  348. vgactlw("type", vesa.name);
  349. }
  350. /*
  351. * The new draw device needs linear mode set
  352. * before size.
  353. */
  354. linear(vga);
  355. /*
  356. * Linear is over so switch to other driver for
  357. * acceleration.
  358. */
  359. if(vga->vesa)
  360. vgactlw("type", vtype);
  361. sprint(buf, "%ludx%ludx%d %s",
  362. vga->virtx, vga->virty,
  363. vga->mode->z, vga->mode->chan);
  364. if(rflag){
  365. vgactlr("size", sizeb);
  366. if(rflag < 2 && strcmp(buf, sizeb) != 0)
  367. error("bad refresh: %s != %s\n",
  368. buf, sizeb);
  369. }
  370. else
  371. vgactlw("size", buf);
  372. /*
  373. * No fiddling with registers if VESA set
  374. * things up already. Sorry.
  375. */
  376. if(!vga->vesa){
  377. /*
  378. * Turn off the display during the load.
  379. */
  380. sequencer(vga, 0);
  381. for(ctlr = vga->link; ctlr; ctlr = ctlr->link){
  382. if(ctlr->load == 0 || ctlr == &vesa)
  383. continue;
  384. trace("%s->load\n", ctlr->name);
  385. (*ctlr->load)(vga, ctlr);
  386. }
  387. sequencer(vga, 1);
  388. }
  389. vgactlw("drawinit", "");
  390. if(vga->hwgc == 0 || cflag)
  391. vgactlw("hwgc", "soft");
  392. else
  393. vgactlw("hwgc", vga->hwgc->name);
  394. if(vga->virtx != vga->mode->x || vga->virty != vga->mode->y){
  395. sprint(buf, "%dx%d", vga->mode->x, vga->mode->y);
  396. vgactlw("actualsize", buf);
  397. if(vga->panning)
  398. vgactlw("panning", "on");
  399. }
  400. if(pflag)
  401. dump(vga);
  402. }
  403. }
  404. trace("main->exits\n");
  405. exits(0);
  406. }