tty3270.c 42 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835
  1. /*
  2. * drivers/s390/char/tty3270.c
  3. * IBM/3270 Driver - tty functions.
  4. *
  5. * Author(s):
  6. * Original 3270 Code for 2.4 written by Richard Hitt (UTS Global)
  7. * Rewritten for 2.5 by Martin Schwidefsky <schwidefsky@de.ibm.com>
  8. * -- Copyright (C) 2003 IBM Deutschland Entwicklung GmbH, IBM Corporation
  9. */
  10. #include <linux/config.h>
  11. #include <linux/module.h>
  12. #include <linux/types.h>
  13. #include <linux/kdev_t.h>
  14. #include <linux/tty.h>
  15. #include <linux/vt_kern.h>
  16. #include <linux/init.h>
  17. #include <linux/console.h>
  18. #include <linux/interrupt.h>
  19. #include <linux/slab.h>
  20. #include <linux/bootmem.h>
  21. #include <asm/ccwdev.h>
  22. #include <asm/cio.h>
  23. #include <asm/ebcdic.h>
  24. #include <asm/uaccess.h>
  25. #include "raw3270.h"
  26. #include "keyboard.h"
  27. #define TTY3270_CHAR_BUF_SIZE 256
  28. #define TTY3270_OUTPUT_BUFFER_SIZE 1024
  29. #define TTY3270_STRING_PAGES 5
  30. struct tty_driver *tty3270_driver;
  31. static int tty3270_max_index;
  32. struct raw3270_fn tty3270_fn;
  33. struct tty3270_cell {
  34. unsigned char character;
  35. unsigned char highlight;
  36. unsigned char f_color;
  37. };
  38. struct tty3270_line {
  39. struct tty3270_cell *cells;
  40. int len;
  41. };
  42. #define ESCAPE_NPAR 8
  43. /*
  44. * The main tty view data structure.
  45. * FIXME:
  46. * 1) describe line orientation & lines list concept against screen
  47. * 2) describe conversion of screen to lines
  48. * 3) describe line format.
  49. */
  50. struct tty3270 {
  51. struct raw3270_view view;
  52. struct tty_struct *tty; /* Pointer to tty structure */
  53. void **freemem_pages; /* Array of pages used for freemem. */
  54. struct list_head freemem; /* List of free memory for strings. */
  55. /* Output stuff. */
  56. struct list_head lines; /* List of lines. */
  57. struct list_head update; /* List of lines to update. */
  58. unsigned char wcc; /* Write control character. */
  59. int nr_lines; /* # lines in list. */
  60. int nr_up; /* # lines up in history. */
  61. unsigned long update_flags; /* Update indication bits. */
  62. struct string *status; /* Lower right of display. */
  63. struct raw3270_request *write; /* Single write request. */
  64. struct timer_list timer; /* Output delay timer. */
  65. /* Current tty screen. */
  66. unsigned int cx, cy; /* Current output position. */
  67. unsigned int highlight; /* Blink/reverse/underscore */
  68. unsigned int f_color; /* Foreground color */
  69. struct tty3270_line *screen;
  70. /* Input stuff. */
  71. struct string *prompt; /* Output string for input area. */
  72. struct string *input; /* Input string for read request. */
  73. struct raw3270_request *read; /* Single read request. */
  74. struct raw3270_request *kreset; /* Single keyboard reset request. */
  75. unsigned char inattr; /* Visible/invisible input. */
  76. int throttle, attn; /* tty throttle/unthrottle. */
  77. struct tasklet_struct readlet; /* Tasklet to issue read request. */
  78. struct kbd_data *kbd; /* key_maps stuff. */
  79. /* Escape sequence parsing. */
  80. int esc_state, esc_ques, esc_npar;
  81. int esc_par[ESCAPE_NPAR];
  82. unsigned int saved_cx, saved_cy;
  83. unsigned int saved_highlight, saved_f_color;
  84. /* Command recalling. */
  85. struct list_head rcl_lines; /* List of recallable lines. */
  86. struct list_head *rcl_walk; /* Point in rcl_lines list. */
  87. int rcl_nr, rcl_max; /* Number/max number of rcl_lines. */
  88. /* Character array for put_char/flush_chars. */
  89. unsigned int char_count;
  90. char char_buf[TTY3270_CHAR_BUF_SIZE];
  91. };
  92. /* tty3270->update_flags. See tty3270_update for details. */
  93. #define TTY_UPDATE_ERASE 1 /* Use EWRITEA instead of WRITE. */
  94. #define TTY_UPDATE_LIST 2 /* Update lines in tty3270->update. */
  95. #define TTY_UPDATE_INPUT 4 /* Update input line. */
  96. #define TTY_UPDATE_STATUS 8 /* Update status line. */
  97. #define TTY_UPDATE_ALL 15
  98. static void tty3270_update(struct tty3270 *);
  99. /*
  100. * Setup timeout for a device. On timeout trigger an update.
  101. */
  102. void
  103. tty3270_set_timer(struct tty3270 *tp, int expires)
  104. {
  105. if (expires == 0) {
  106. if (timer_pending(&tp->timer) && del_timer(&tp->timer))
  107. raw3270_put_view(&tp->view);
  108. return;
  109. }
  110. if (timer_pending(&tp->timer) &&
  111. mod_timer(&tp->timer, jiffies + expires))
  112. return;
  113. raw3270_get_view(&tp->view);
  114. tp->timer.function = (void (*)(unsigned long)) tty3270_update;
  115. tp->timer.data = (unsigned long) tp;
  116. tp->timer.expires = jiffies + expires;
  117. add_timer(&tp->timer);
  118. }
  119. /*
  120. * The input line are the two last lines of the screen.
  121. */
  122. static void
  123. tty3270_update_prompt(struct tty3270 *tp, char *input, int count)
  124. {
  125. struct string *line;
  126. unsigned int off;
  127. line = tp->prompt;
  128. if (count != 0)
  129. line->string[5] = TF_INMDT;
  130. else
  131. line->string[5] = tp->inattr;
  132. if (count > tp->view.cols * 2 - 11)
  133. count = tp->view.cols * 2 - 11;
  134. memcpy(line->string + 6, input, count);
  135. line->string[6 + count] = TO_IC;
  136. /* Clear to end of input line. */
  137. if (count < tp->view.cols * 2 - 11) {
  138. line->string[7 + count] = TO_RA;
  139. line->string[10 + count] = 0;
  140. off = tp->view.cols * tp->view.rows - 9;
  141. raw3270_buffer_address(tp->view.dev, line->string+count+8, off);
  142. line->len = 11 + count;
  143. } else
  144. line->len = 7 + count;
  145. tp->update_flags |= TTY_UPDATE_INPUT;
  146. }
  147. static void
  148. tty3270_create_prompt(struct tty3270 *tp)
  149. {
  150. static const unsigned char blueprint[] =
  151. { TO_SBA, 0, 0, 0x6e, TO_SF, TF_INPUT,
  152. /* empty input string */
  153. TO_IC, TO_RA, 0, 0, 0 };
  154. struct string *line;
  155. unsigned int offset;
  156. line = alloc_string(&tp->freemem,
  157. sizeof(blueprint) + tp->view.cols * 2 - 9);
  158. tp->prompt = line;
  159. tp->inattr = TF_INPUT;
  160. /* Copy blueprint to status line */
  161. memcpy(line->string, blueprint, sizeof(blueprint));
  162. line->len = sizeof(blueprint);
  163. /* Set output offsets. */
  164. offset = tp->view.cols * (tp->view.rows - 2);
  165. raw3270_buffer_address(tp->view.dev, line->string + 1, offset);
  166. offset = tp->view.cols * tp->view.rows - 9;
  167. raw3270_buffer_address(tp->view.dev, line->string + 8, offset);
  168. /* Allocate input string for reading. */
  169. tp->input = alloc_string(&tp->freemem, tp->view.cols * 2 - 9 + 6);
  170. }
  171. /*
  172. * The status line is the last line of the screen. It shows the string
  173. * "Running"/"Holding" in the lower right corner of the screen.
  174. */
  175. static void
  176. tty3270_update_status(struct tty3270 * tp)
  177. {
  178. char *str;
  179. str = (tp->nr_up != 0) ? "History" : "Running";
  180. memcpy(tp->status->string + 8, str, 7);
  181. codepage_convert(tp->view.ascebc, tp->status->string + 8, 7);
  182. tp->update_flags |= TTY_UPDATE_STATUS;
  183. }
  184. static void
  185. tty3270_create_status(struct tty3270 * tp)
  186. {
  187. static const unsigned char blueprint[] =
  188. { TO_SBA, 0, 0, TO_SF, TF_LOG, TO_SA, TAT_COLOR, TAC_GREEN,
  189. 0, 0, 0, 0, 0, 0, 0, TO_SF, TF_LOG, TO_SA, TAT_COLOR,
  190. TAC_RESET };
  191. struct string *line;
  192. unsigned int offset;
  193. line = alloc_string(&tp->freemem,sizeof(blueprint));
  194. tp->status = line;
  195. /* Copy blueprint to status line */
  196. memcpy(line->string, blueprint, sizeof(blueprint));
  197. /* Set address to start of status string (= last 9 characters). */
  198. offset = tp->view.cols * tp->view.rows - 9;
  199. raw3270_buffer_address(tp->view.dev, line->string + 1, offset);
  200. }
  201. /*
  202. * Set output offsets to 3270 datastream fragment of a tty string.
  203. * (TO_SBA offset at the start and TO_RA offset at the end of the string)
  204. */
  205. static void
  206. tty3270_update_string(struct tty3270 *tp, struct string *line, int nr)
  207. {
  208. unsigned char *cp;
  209. raw3270_buffer_address(tp->view.dev, line->string + 1,
  210. tp->view.cols * nr);
  211. cp = line->string + line->len - 4;
  212. if (*cp == TO_RA)
  213. raw3270_buffer_address(tp->view.dev, cp + 1,
  214. tp->view.cols * (nr + 1));
  215. }
  216. /*
  217. * Rebuild update list to print all lines.
  218. */
  219. static void
  220. tty3270_rebuild_update(struct tty3270 *tp)
  221. {
  222. struct string *s, *n;
  223. int line, nr_up;
  224. /*
  225. * Throw away update list and create a new one,
  226. * containing all lines that will fit on the screen.
  227. */
  228. list_for_each_entry_safe(s, n, &tp->update, update)
  229. list_del_init(&s->update);
  230. line = tp->view.rows - 3;
  231. nr_up = tp->nr_up;
  232. list_for_each_entry_reverse(s, &tp->lines, list) {
  233. if (nr_up > 0) {
  234. nr_up--;
  235. continue;
  236. }
  237. tty3270_update_string(tp, s, line);
  238. list_add(&s->update, &tp->update);
  239. if (--line < 0)
  240. break;
  241. }
  242. tp->update_flags |= TTY_UPDATE_LIST;
  243. }
  244. /*
  245. * Alloc string for size bytes. If there is not enough room in
  246. * freemem, free strings until there is room.
  247. */
  248. static struct string *
  249. tty3270_alloc_string(struct tty3270 *tp, size_t size)
  250. {
  251. struct string *s, *n;
  252. s = alloc_string(&tp->freemem, size);
  253. if (s)
  254. return s;
  255. list_for_each_entry_safe(s, n, &tp->lines, list) {
  256. BUG_ON(tp->nr_lines <= tp->view.rows - 2);
  257. list_del(&s->list);
  258. if (!list_empty(&s->update))
  259. list_del(&s->update);
  260. tp->nr_lines--;
  261. if (free_string(&tp->freemem, s) >= size)
  262. break;
  263. }
  264. s = alloc_string(&tp->freemem, size);
  265. BUG_ON(!s);
  266. if (tp->nr_up != 0 &&
  267. tp->nr_up + tp->view.rows - 2 >= tp->nr_lines) {
  268. tp->nr_up = tp->nr_lines - tp->view.rows + 2;
  269. tty3270_rebuild_update(tp);
  270. tty3270_update_status(tp);
  271. }
  272. return s;
  273. }
  274. /*
  275. * Add an empty line to the list.
  276. */
  277. static void
  278. tty3270_blank_line(struct tty3270 *tp)
  279. {
  280. static const unsigned char blueprint[] =
  281. { TO_SBA, 0, 0, TO_SA, TAT_EXTHI, TAX_RESET,
  282. TO_SA, TAT_COLOR, TAC_RESET, TO_RA, 0, 0, 0 };
  283. struct string *s;
  284. s = tty3270_alloc_string(tp, sizeof(blueprint));
  285. memcpy(s->string, blueprint, sizeof(blueprint));
  286. s->len = sizeof(blueprint);
  287. list_add_tail(&s->list, &tp->lines);
  288. tp->nr_lines++;
  289. if (tp->nr_up != 0)
  290. tp->nr_up++;
  291. }
  292. /*
  293. * Write request completion callback.
  294. */
  295. static void
  296. tty3270_write_callback(struct raw3270_request *rq, void *data)
  297. {
  298. struct tty3270 *tp;
  299. tp = (struct tty3270 *) rq->view;
  300. if (rq->rc != 0) {
  301. /* Write wasn't successfull. Refresh all. */
  302. tty3270_rebuild_update(tp);
  303. tp->update_flags = TTY_UPDATE_ALL;
  304. tty3270_set_timer(tp, 1);
  305. }
  306. raw3270_request_reset(rq);
  307. xchg(&tp->write, rq);
  308. }
  309. /*
  310. * Update 3270 display.
  311. */
  312. static void
  313. tty3270_update(struct tty3270 *tp)
  314. {
  315. static char invalid_sba[2] = { 0xff, 0xff };
  316. struct raw3270_request *wrq;
  317. unsigned long updated;
  318. struct string *s, *n;
  319. char *sba, *str;
  320. int rc, len;
  321. wrq = xchg(&tp->write, 0);
  322. if (!wrq) {
  323. tty3270_set_timer(tp, 1);
  324. return;
  325. }
  326. spin_lock(&tp->view.lock);
  327. updated = 0;
  328. if (tp->update_flags & TTY_UPDATE_ERASE) {
  329. /* Use erase write alternate to erase display. */
  330. raw3270_request_set_cmd(wrq, TC_EWRITEA);
  331. updated |= TTY_UPDATE_ERASE;
  332. } else
  333. raw3270_request_set_cmd(wrq, TC_WRITE);
  334. raw3270_request_add_data(wrq, &tp->wcc, 1);
  335. tp->wcc = TW_NONE;
  336. /*
  337. * Update status line.
  338. */
  339. if (tp->update_flags & TTY_UPDATE_STATUS)
  340. if (raw3270_request_add_data(wrq, tp->status->string,
  341. tp->status->len) == 0)
  342. updated |= TTY_UPDATE_STATUS;
  343. /*
  344. * Write input line.
  345. */
  346. if (tp->update_flags & TTY_UPDATE_INPUT)
  347. if (raw3270_request_add_data(wrq, tp->prompt->string,
  348. tp->prompt->len) == 0)
  349. updated |= TTY_UPDATE_INPUT;
  350. sba = invalid_sba;
  351. if (tp->update_flags & TTY_UPDATE_LIST) {
  352. /* Write strings in the update list to the screen. */
  353. list_for_each_entry_safe(s, n, &tp->update, update) {
  354. str = s->string;
  355. len = s->len;
  356. /*
  357. * Skip TO_SBA at the start of the string if the
  358. * last output position matches the start address
  359. * of this line.
  360. */
  361. if (s->string[1] == sba[0] && s->string[2] == sba[1])
  362. str += 3, len -= 3;
  363. if (raw3270_request_add_data(wrq, str, len) != 0)
  364. break;
  365. list_del_init(&s->update);
  366. sba = s->string + s->len - 3;
  367. }
  368. if (list_empty(&tp->update))
  369. updated |= TTY_UPDATE_LIST;
  370. }
  371. wrq->callback = tty3270_write_callback;
  372. rc = raw3270_start(&tp->view, wrq);
  373. if (rc == 0) {
  374. tp->update_flags &= ~updated;
  375. if (tp->update_flags)
  376. tty3270_set_timer(tp, 1);
  377. } else {
  378. raw3270_request_reset(wrq);
  379. xchg(&tp->write, wrq);
  380. }
  381. spin_unlock(&tp->view.lock);
  382. raw3270_put_view(&tp->view);
  383. }
  384. /*
  385. * Command recalling.
  386. */
  387. static void
  388. tty3270_rcl_add(struct tty3270 *tp, char *input, int len)
  389. {
  390. struct string *s;
  391. tp->rcl_walk = 0;
  392. if (len <= 0)
  393. return;
  394. if (tp->rcl_nr >= tp->rcl_max) {
  395. s = list_entry(tp->rcl_lines.next, struct string, list);
  396. list_del(&s->list);
  397. free_string(&tp->freemem, s);
  398. tp->rcl_nr--;
  399. }
  400. s = tty3270_alloc_string(tp, len);
  401. memcpy(s->string, input, len);
  402. list_add_tail(&s->list, &tp->rcl_lines);
  403. tp->rcl_nr++;
  404. }
  405. static void
  406. tty3270_rcl_backward(struct kbd_data *kbd)
  407. {
  408. struct tty3270 *tp;
  409. struct string *s;
  410. tp = kbd->tty->driver_data;
  411. spin_lock_bh(&tp->view.lock);
  412. if (tp->inattr == TF_INPUT) {
  413. if (tp->rcl_walk && tp->rcl_walk->prev != &tp->rcl_lines)
  414. tp->rcl_walk = tp->rcl_walk->prev;
  415. else if (!list_empty(&tp->rcl_lines))
  416. tp->rcl_walk = tp->rcl_lines.prev;
  417. s = tp->rcl_walk ?
  418. list_entry(tp->rcl_walk, struct string, list) : 0;
  419. if (tp->rcl_walk) {
  420. s = list_entry(tp->rcl_walk, struct string, list);
  421. tty3270_update_prompt(tp, s->string, s->len);
  422. } else
  423. tty3270_update_prompt(tp, 0, 0);
  424. tty3270_set_timer(tp, 1);
  425. }
  426. spin_unlock_bh(&tp->view.lock);
  427. }
  428. /*
  429. * Deactivate tty view.
  430. */
  431. static void
  432. tty3270_exit_tty(struct kbd_data *kbd)
  433. {
  434. struct tty3270 *tp;
  435. tp = kbd->tty->driver_data;
  436. raw3270_deactivate_view(&tp->view);
  437. }
  438. /*
  439. * Scroll forward in history.
  440. */
  441. static void
  442. tty3270_scroll_forward(struct kbd_data *kbd)
  443. {
  444. struct tty3270 *tp;
  445. int nr_up;
  446. tp = kbd->tty->driver_data;
  447. spin_lock_bh(&tp->view.lock);
  448. nr_up = tp->nr_up - tp->view.rows + 2;
  449. if (nr_up < 0)
  450. nr_up = 0;
  451. if (nr_up != tp->nr_up) {
  452. tp->nr_up = nr_up;
  453. tty3270_rebuild_update(tp);
  454. tty3270_update_status(tp);
  455. tty3270_set_timer(tp, 1);
  456. }
  457. spin_unlock_bh(&tp->view.lock);
  458. }
  459. /*
  460. * Scroll backward in history.
  461. */
  462. static void
  463. tty3270_scroll_backward(struct kbd_data *kbd)
  464. {
  465. struct tty3270 *tp;
  466. int nr_up;
  467. tp = kbd->tty->driver_data;
  468. spin_lock_bh(&tp->view.lock);
  469. nr_up = tp->nr_up + tp->view.rows - 2;
  470. if (nr_up + tp->view.rows - 2 > tp->nr_lines)
  471. nr_up = tp->nr_lines - tp->view.rows + 2;
  472. if (nr_up != tp->nr_up) {
  473. tp->nr_up = nr_up;
  474. tty3270_rebuild_update(tp);
  475. tty3270_update_status(tp);
  476. tty3270_set_timer(tp, 1);
  477. }
  478. spin_unlock_bh(&tp->view.lock);
  479. }
  480. /*
  481. * Pass input line to tty.
  482. */
  483. static void
  484. tty3270_read_tasklet(struct raw3270_request *rrq)
  485. {
  486. static char kreset_data = TW_KR;
  487. struct tty3270 *tp;
  488. char *input;
  489. int len;
  490. tp = (struct tty3270 *) rrq->view;
  491. spin_lock_bh(&tp->view.lock);
  492. /*
  493. * Two AID keys are special: For 0x7d (enter) the input line
  494. * has to be emitted to the tty and for 0x6d the screen
  495. * needs to be redrawn.
  496. */
  497. input = 0;
  498. len = 0;
  499. if (tp->input->string[0] == 0x7d) {
  500. /* Enter: write input to tty. */
  501. input = tp->input->string + 6;
  502. len = tp->input->len - 6 - rrq->rescnt;
  503. if (tp->inattr != TF_INPUTN)
  504. tty3270_rcl_add(tp, input, len);
  505. if (tp->nr_up > 0) {
  506. tp->nr_up = 0;
  507. tty3270_rebuild_update(tp);
  508. tty3270_update_status(tp);
  509. }
  510. /* Clear input area. */
  511. tty3270_update_prompt(tp, 0, 0);
  512. tty3270_set_timer(tp, 1);
  513. } else if (tp->input->string[0] == 0x6d) {
  514. /* Display has been cleared. Redraw. */
  515. tty3270_rebuild_update(tp);
  516. tp->update_flags = TTY_UPDATE_ALL;
  517. tty3270_set_timer(tp, 1);
  518. }
  519. spin_unlock_bh(&tp->view.lock);
  520. /* Start keyboard reset command. */
  521. raw3270_request_reset(tp->kreset);
  522. raw3270_request_set_cmd(tp->kreset, TC_WRITE);
  523. raw3270_request_add_data(tp->kreset, &kreset_data, 1);
  524. raw3270_start(&tp->view, tp->kreset);
  525. /* Emit input string. */
  526. if (tp->tty) {
  527. while (len-- > 0)
  528. kbd_keycode(tp->kbd, *input++);
  529. /* Emit keycode for AID byte. */
  530. kbd_keycode(tp->kbd, 256 + tp->input->string[0]);
  531. }
  532. raw3270_request_reset(rrq);
  533. xchg(&tp->read, rrq);
  534. raw3270_put_view(&tp->view);
  535. }
  536. /*
  537. * Read request completion callback.
  538. */
  539. static void
  540. tty3270_read_callback(struct raw3270_request *rq, void *data)
  541. {
  542. raw3270_get_view(rq->view);
  543. /* Schedule tasklet to pass input to tty. */
  544. tasklet_schedule(&((struct tty3270 *) rq->view)->readlet);
  545. }
  546. /*
  547. * Issue a read request. Call with device lock.
  548. */
  549. static void
  550. tty3270_issue_read(struct tty3270 *tp, int lock)
  551. {
  552. struct raw3270_request *rrq;
  553. int rc;
  554. rrq = xchg(&tp->read, 0);
  555. if (!rrq)
  556. /* Read already scheduled. */
  557. return;
  558. rrq->callback = tty3270_read_callback;
  559. rrq->callback_data = tp;
  560. raw3270_request_set_cmd(rrq, TC_READMOD);
  561. raw3270_request_set_data(rrq, tp->input->string, tp->input->len);
  562. /* Issue the read modified request. */
  563. if (lock) {
  564. rc = raw3270_start(&tp->view, rrq);
  565. } else
  566. rc = raw3270_start_irq(&tp->view, rrq);
  567. if (rc) {
  568. raw3270_request_reset(rrq);
  569. xchg(&tp->read, rrq);
  570. }
  571. }
  572. /*
  573. * Switch to the tty view.
  574. */
  575. static int
  576. tty3270_activate(struct raw3270_view *view)
  577. {
  578. struct tty3270 *tp;
  579. unsigned long flags;
  580. tp = (struct tty3270 *) view;
  581. spin_lock_irqsave(&tp->view.lock, flags);
  582. tp->nr_up = 0;
  583. tty3270_rebuild_update(tp);
  584. tty3270_update_status(tp);
  585. tp->update_flags = TTY_UPDATE_ALL;
  586. tty3270_set_timer(tp, 1);
  587. spin_unlock_irqrestore(&tp->view.lock, flags);
  588. return 0;
  589. }
  590. static void
  591. tty3270_deactivate(struct raw3270_view *view)
  592. {
  593. }
  594. static int
  595. tty3270_irq(struct tty3270 *tp, struct raw3270_request *rq, struct irb *irb)
  596. {
  597. /* Handle ATTN. Schedule tasklet to read aid. */
  598. if (irb->scsw.dstat & DEV_STAT_ATTENTION) {
  599. if (!tp->throttle)
  600. tty3270_issue_read(tp, 0);
  601. else
  602. tp->attn = 1;
  603. }
  604. if (rq) {
  605. if (irb->scsw.dstat & DEV_STAT_UNIT_CHECK)
  606. rq->rc = -EIO;
  607. else
  608. /* Normal end. Copy residual count. */
  609. rq->rescnt = irb->scsw.count;
  610. }
  611. return RAW3270_IO_DONE;
  612. }
  613. /*
  614. * Allocate tty3270 structure.
  615. */
  616. static struct tty3270 *
  617. tty3270_alloc_view(void)
  618. {
  619. struct tty3270 *tp;
  620. int pages;
  621. tp = kmalloc(sizeof(struct tty3270),GFP_KERNEL);
  622. if (!tp)
  623. goto out_err;
  624. memset(tp, 0, sizeof(struct tty3270));
  625. tp->freemem_pages =
  626. kmalloc(sizeof(void *) * TTY3270_STRING_PAGES, GFP_KERNEL);
  627. if (!tp->freemem_pages)
  628. goto out_tp;
  629. INIT_LIST_HEAD(&tp->freemem);
  630. init_timer(&tp->timer);
  631. for (pages = 0; pages < TTY3270_STRING_PAGES; pages++) {
  632. tp->freemem_pages[pages] = (void *)
  633. __get_free_pages(GFP_KERNEL|GFP_DMA, 0);
  634. if (!tp->freemem_pages[pages])
  635. goto out_pages;
  636. add_string_memory(&tp->freemem,
  637. tp->freemem_pages[pages], PAGE_SIZE);
  638. }
  639. tp->write = raw3270_request_alloc(TTY3270_OUTPUT_BUFFER_SIZE);
  640. if (IS_ERR(tp->write))
  641. goto out_pages;
  642. tp->read = raw3270_request_alloc(0);
  643. if (IS_ERR(tp->read))
  644. goto out_write;
  645. tp->kreset = raw3270_request_alloc(1);
  646. if (IS_ERR(tp->kreset))
  647. goto out_read;
  648. tp->kbd = kbd_alloc();
  649. if (!tp->kbd)
  650. goto out_reset;
  651. return tp;
  652. out_reset:
  653. raw3270_request_free(tp->kreset);
  654. out_read:
  655. raw3270_request_free(tp->read);
  656. out_write:
  657. raw3270_request_free(tp->write);
  658. out_pages:
  659. while (pages--)
  660. free_pages((unsigned long) tp->freemem_pages[pages], 0);
  661. kfree(tp->freemem_pages);
  662. out_tp:
  663. kfree(tp);
  664. out_err:
  665. return ERR_PTR(-ENOMEM);
  666. }
  667. /*
  668. * Free tty3270 structure.
  669. */
  670. static void
  671. tty3270_free_view(struct tty3270 *tp)
  672. {
  673. int pages;
  674. kbd_free(tp->kbd);
  675. raw3270_request_free(tp->kreset);
  676. raw3270_request_free(tp->read);
  677. raw3270_request_free(tp->write);
  678. for (pages = 0; pages < TTY3270_STRING_PAGES; pages++)
  679. free_pages((unsigned long) tp->freemem_pages[pages], 0);
  680. kfree(tp->freemem_pages);
  681. kfree(tp);
  682. }
  683. /*
  684. * Allocate tty3270 screen.
  685. */
  686. static int
  687. tty3270_alloc_screen(struct tty3270 *tp)
  688. {
  689. unsigned long size;
  690. int lines;
  691. size = sizeof(struct tty3270_line) * (tp->view.rows - 2);
  692. tp->screen = kmalloc(size, GFP_KERNEL);
  693. if (!tp->screen)
  694. goto out_err;
  695. memset(tp->screen, 0, size);
  696. for (lines = 0; lines < tp->view.rows - 2; lines++) {
  697. size = sizeof(struct tty3270_cell) * tp->view.cols;
  698. tp->screen[lines].cells = kmalloc(size, GFP_KERNEL);
  699. if (!tp->screen[lines].cells)
  700. goto out_screen;
  701. memset(tp->screen[lines].cells, 0, size);
  702. }
  703. return 0;
  704. out_screen:
  705. while (lines--)
  706. kfree(tp->screen[lines].cells);
  707. kfree(tp->screen);
  708. out_err:
  709. return -ENOMEM;
  710. }
  711. /*
  712. * Free tty3270 screen.
  713. */
  714. static void
  715. tty3270_free_screen(struct tty3270 *tp)
  716. {
  717. int lines;
  718. for (lines = 0; lines < tp->view.rows - 2; lines++)
  719. kfree(tp->screen[lines].cells);
  720. kfree(tp->screen);
  721. }
  722. /*
  723. * Unlink tty3270 data structure from tty.
  724. */
  725. static void
  726. tty3270_release(struct raw3270_view *view)
  727. {
  728. struct tty3270 *tp;
  729. struct tty_struct *tty;
  730. tp = (struct tty3270 *) view;
  731. tty = tp->tty;
  732. if (tty) {
  733. tty->driver_data = 0;
  734. tp->tty = tp->kbd->tty = 0;
  735. tty_hangup(tty);
  736. raw3270_put_view(&tp->view);
  737. }
  738. }
  739. /*
  740. * Free tty3270 data structure
  741. */
  742. static void
  743. tty3270_free(struct raw3270_view *view)
  744. {
  745. tty3270_free_screen((struct tty3270 *) view);
  746. tty3270_free_view((struct tty3270 *) view);
  747. }
  748. /*
  749. * Delayed freeing of tty3270 views.
  750. */
  751. static void
  752. tty3270_del_views(void)
  753. {
  754. struct tty3270 *tp;
  755. int i;
  756. for (i = 0; i < tty3270_max_index; i++) {
  757. tp = (struct tty3270 *)
  758. raw3270_find_view(&tty3270_fn, i + RAW3270_FIRSTMINOR);
  759. if (!IS_ERR(tp))
  760. raw3270_del_view(&tp->view);
  761. }
  762. }
  763. struct raw3270_fn tty3270_fn = {
  764. .activate = tty3270_activate,
  765. .deactivate = tty3270_deactivate,
  766. .intv = (void *) tty3270_irq,
  767. .release = tty3270_release,
  768. .free = tty3270_free
  769. };
  770. /*
  771. * This routine is called whenever a 3270 tty is opened.
  772. */
  773. static int
  774. tty3270_open(struct tty_struct *tty, struct file * filp)
  775. {
  776. struct tty3270 *tp;
  777. int i, rc;
  778. if (tty->count > 1)
  779. return 0;
  780. /* Check if the tty3270 is already there. */
  781. tp = (struct tty3270 *)
  782. raw3270_find_view(&tty3270_fn,
  783. tty->index + RAW3270_FIRSTMINOR);
  784. if (!IS_ERR(tp)) {
  785. tty->driver_data = tp;
  786. tty->winsize.ws_row = tp->view.rows - 2;
  787. tty->winsize.ws_col = tp->view.cols;
  788. tty->low_latency = 0;
  789. tp->tty = tty;
  790. tp->kbd->tty = tty;
  791. tp->inattr = TF_INPUT;
  792. return 0;
  793. }
  794. if (tty3270_max_index < tty->index + 1)
  795. tty3270_max_index = tty->index + 1;
  796. /* Quick exit if there is no device for tty->index. */
  797. if (PTR_ERR(tp) == -ENODEV)
  798. return -ENODEV;
  799. /* Allocate tty3270 structure on first open. */
  800. tp = tty3270_alloc_view();
  801. if (IS_ERR(tp))
  802. return PTR_ERR(tp);
  803. INIT_LIST_HEAD(&tp->lines);
  804. INIT_LIST_HEAD(&tp->update);
  805. INIT_LIST_HEAD(&tp->rcl_lines);
  806. tp->rcl_max = 20;
  807. init_timer(&tp->timer);
  808. tasklet_init(&tp->readlet,
  809. (void (*)(unsigned long)) tty3270_read_tasklet,
  810. (unsigned long) tp->read);
  811. rc = raw3270_add_view(&tp->view, &tty3270_fn,
  812. tty->index + RAW3270_FIRSTMINOR);
  813. if (rc) {
  814. tty3270_free_view(tp);
  815. return rc;
  816. }
  817. rc = tty3270_alloc_screen(tp);
  818. if (rc) {
  819. raw3270_put_view(&tp->view);
  820. raw3270_del_view(&tp->view);
  821. return rc;
  822. }
  823. tp->tty = tty;
  824. tty->low_latency = 0;
  825. tty->driver_data = tp;
  826. tty->winsize.ws_row = tp->view.rows - 2;
  827. tty->winsize.ws_col = tp->view.cols;
  828. tty3270_create_prompt(tp);
  829. tty3270_create_status(tp);
  830. tty3270_update_status(tp);
  831. /* Create blank line for every line in the tty output area. */
  832. for (i = 0; i < tp->view.rows - 2; i++)
  833. tty3270_blank_line(tp);
  834. tp->kbd->tty = tty;
  835. tp->kbd->fn_handler[KVAL(K_INCRCONSOLE)] = tty3270_exit_tty;
  836. tp->kbd->fn_handler[KVAL(K_SCROLLBACK)] = tty3270_scroll_backward;
  837. tp->kbd->fn_handler[KVAL(K_SCROLLFORW)] = tty3270_scroll_forward;
  838. tp->kbd->fn_handler[KVAL(K_CONS)] = tty3270_rcl_backward;
  839. kbd_ascebc(tp->kbd, tp->view.ascebc);
  840. raw3270_activate_view(&tp->view);
  841. return 0;
  842. }
  843. /*
  844. * This routine is called when the 3270 tty is closed. We wait
  845. * for the remaining request to be completed. Then we clean up.
  846. */
  847. static void
  848. tty3270_close(struct tty_struct *tty, struct file * filp)
  849. {
  850. struct tty3270 *tp;
  851. if (tty->count > 1)
  852. return;
  853. tp = (struct tty3270 *) tty->driver_data;
  854. if (tp) {
  855. tty->driver_data = 0;
  856. tp->tty = tp->kbd->tty = 0;
  857. raw3270_put_view(&tp->view);
  858. }
  859. }
  860. /*
  861. * We always have room.
  862. */
  863. static int
  864. tty3270_write_room(struct tty_struct *tty)
  865. {
  866. return INT_MAX;
  867. }
  868. /*
  869. * Insert character into the screen at the current position with the
  870. * current color and highlight. This function does NOT do cursor movement.
  871. */
  872. static void
  873. tty3270_put_character(struct tty3270 *tp, char ch)
  874. {
  875. struct tty3270_line *line;
  876. struct tty3270_cell *cell;
  877. line = tp->screen + tp->cy;
  878. if (line->len <= tp->cx) {
  879. while (line->len < tp->cx) {
  880. cell = line->cells + line->len;
  881. cell->character = tp->view.ascebc[' '];
  882. cell->highlight = tp->highlight;
  883. cell->f_color = tp->f_color;
  884. line->len++;
  885. }
  886. line->len++;
  887. }
  888. cell = line->cells + tp->cx;
  889. cell->character = tp->view.ascebc[(unsigned int) ch];
  890. cell->highlight = tp->highlight;
  891. cell->f_color = tp->f_color;
  892. }
  893. /*
  894. * Convert a tty3270_line to a 3270 data fragment usable for output.
  895. */
  896. static void
  897. tty3270_convert_line(struct tty3270 *tp, int line_nr)
  898. {
  899. struct tty3270_line *line;
  900. struct tty3270_cell *cell;
  901. struct string *s, *n;
  902. unsigned char highlight;
  903. unsigned char f_color;
  904. char *cp;
  905. int flen, i;
  906. /* Determine how long the fragment will be. */
  907. flen = 3; /* Prefix (TO_SBA). */
  908. line = tp->screen + line_nr;
  909. flen += line->len;
  910. highlight = TAX_RESET;
  911. f_color = TAC_RESET;
  912. for (i = 0, cell = line->cells; i < line->len; i++, cell++) {
  913. if (cell->highlight != highlight) {
  914. flen += 3; /* TO_SA to switch highlight. */
  915. highlight = cell->highlight;
  916. }
  917. if (cell->f_color != f_color) {
  918. flen += 3; /* TO_SA to switch color. */
  919. f_color = cell->f_color;
  920. }
  921. }
  922. if (highlight != TAX_RESET)
  923. flen += 3; /* TO_SA to reset hightlight. */
  924. if (f_color != TAC_RESET)
  925. flen += 3; /* TO_SA to reset color. */
  926. if (line->len < tp->view.cols)
  927. flen += 4; /* Postfix (TO_RA). */
  928. /* Find the line in the list. */
  929. i = tp->view.rows - 2 - line_nr;
  930. list_for_each_entry_reverse(s, &tp->lines, list)
  931. if (--i <= 0)
  932. break;
  933. /*
  934. * Check if the line needs to get reallocated.
  935. */
  936. if (s->len != flen) {
  937. /* Reallocate string. */
  938. n = tty3270_alloc_string(tp, flen);
  939. list_add(&n->list, &s->list);
  940. list_del_init(&s->list);
  941. if (!list_empty(&s->update))
  942. list_del_init(&s->update);
  943. free_string(&tp->freemem, s);
  944. s = n;
  945. }
  946. /* Write 3270 data fragment. */
  947. cp = s->string;
  948. *cp++ = TO_SBA;
  949. *cp++ = 0;
  950. *cp++ = 0;
  951. highlight = TAX_RESET;
  952. f_color = TAC_RESET;
  953. for (i = 0, cell = line->cells; i < line->len; i++, cell++) {
  954. if (cell->highlight != highlight) {
  955. *cp++ = TO_SA;
  956. *cp++ = TAT_EXTHI;
  957. *cp++ = cell->highlight;
  958. highlight = cell->highlight;
  959. }
  960. if (cell->f_color != f_color) {
  961. *cp++ = TO_SA;
  962. *cp++ = TAT_COLOR;
  963. *cp++ = cell->f_color;
  964. f_color = cell->f_color;
  965. }
  966. *cp++ = cell->character;
  967. }
  968. if (highlight != TAX_RESET) {
  969. *cp++ = TO_SA;
  970. *cp++ = TAT_EXTHI;
  971. *cp++ = TAX_RESET;
  972. }
  973. if (f_color != TAC_RESET) {
  974. *cp++ = TO_SA;
  975. *cp++ = TAT_COLOR;
  976. *cp++ = TAC_RESET;
  977. }
  978. if (line->len < tp->view.cols) {
  979. *cp++ = TO_RA;
  980. *cp++ = 0;
  981. *cp++ = 0;
  982. *cp++ = 0;
  983. }
  984. if (tp->nr_up + line_nr < tp->view.rows - 2) {
  985. /* Line is currently visible on screen. */
  986. tty3270_update_string(tp, s, line_nr);
  987. /* Add line to update list. */
  988. if (list_empty(&s->update)) {
  989. list_add_tail(&s->update, &tp->update);
  990. tp->update_flags |= TTY_UPDATE_LIST;
  991. }
  992. }
  993. }
  994. /*
  995. * Do carriage return.
  996. */
  997. static void
  998. tty3270_cr(struct tty3270 *tp)
  999. {
  1000. tp->cx = 0;
  1001. }
  1002. /*
  1003. * Do line feed.
  1004. */
  1005. static void
  1006. tty3270_lf(struct tty3270 *tp)
  1007. {
  1008. struct tty3270_line temp;
  1009. int i;
  1010. tty3270_convert_line(tp, tp->cy);
  1011. if (tp->cy < tp->view.rows - 3) {
  1012. tp->cy++;
  1013. return;
  1014. }
  1015. /* Last line just filled up. Add new, blank line. */
  1016. tty3270_blank_line(tp);
  1017. temp = tp->screen[0];
  1018. temp.len = 0;
  1019. for (i = 0; i < tp->view.rows - 3; i++)
  1020. tp->screen[i] = tp->screen[i+1];
  1021. tp->screen[tp->view.rows - 3] = temp;
  1022. tty3270_rebuild_update(tp);
  1023. }
  1024. static void
  1025. tty3270_ri(struct tty3270 *tp)
  1026. {
  1027. if (tp->cy > 0) {
  1028. tty3270_convert_line(tp, tp->cy);
  1029. tp->cy--;
  1030. }
  1031. }
  1032. /*
  1033. * Insert characters at current position.
  1034. */
  1035. static void
  1036. tty3270_insert_characters(struct tty3270 *tp, int n)
  1037. {
  1038. struct tty3270_line *line;
  1039. int k;
  1040. line = tp->screen + tp->cy;
  1041. while (line->len < tp->cx) {
  1042. line->cells[line->len].character = tp->view.ascebc[' '];
  1043. line->cells[line->len].highlight = TAX_RESET;
  1044. line->cells[line->len].f_color = TAC_RESET;
  1045. line->len++;
  1046. }
  1047. if (n > tp->view.cols - tp->cx)
  1048. n = tp->view.cols - tp->cx;
  1049. k = min_t(int, line->len - tp->cx, tp->view.cols - tp->cx - n);
  1050. while (k--)
  1051. line->cells[tp->cx + n + k] = line->cells[tp->cx + k];
  1052. line->len += n;
  1053. if (line->len > tp->view.cols)
  1054. line->len = tp->view.cols;
  1055. while (n-- > 0) {
  1056. line->cells[tp->cx + n].character = tp->view.ascebc[' '];
  1057. line->cells[tp->cx + n].highlight = tp->highlight;
  1058. line->cells[tp->cx + n].f_color = tp->f_color;
  1059. }
  1060. }
  1061. /*
  1062. * Delete characters at current position.
  1063. */
  1064. static void
  1065. tty3270_delete_characters(struct tty3270 *tp, int n)
  1066. {
  1067. struct tty3270_line *line;
  1068. int i;
  1069. line = tp->screen + tp->cy;
  1070. if (line->len <= tp->cx)
  1071. return;
  1072. if (line->len - tp->cx <= n) {
  1073. line->len = tp->cx;
  1074. return;
  1075. }
  1076. for (i = tp->cx; i + n < line->len; i++)
  1077. line->cells[i] = line->cells[i + n];
  1078. line->len -= n;
  1079. }
  1080. /*
  1081. * Erase characters at current position.
  1082. */
  1083. static void
  1084. tty3270_erase_characters(struct tty3270 *tp, int n)
  1085. {
  1086. struct tty3270_line *line;
  1087. struct tty3270_cell *cell;
  1088. line = tp->screen + tp->cy;
  1089. while (line->len > tp->cx && n-- > 0) {
  1090. cell = line->cells + tp->cx++;
  1091. cell->character = ' ';
  1092. cell->highlight = TAX_RESET;
  1093. cell->f_color = TAC_RESET;
  1094. }
  1095. tp->cx += n;
  1096. tp->cx = min_t(int, tp->cx, tp->view.cols - 1);
  1097. }
  1098. /*
  1099. * Erase line, 3 different cases:
  1100. * Esc [ 0 K Erase from current position to end of line inclusive
  1101. * Esc [ 1 K Erase from beginning of line to current position inclusive
  1102. * Esc [ 2 K Erase entire line (without moving cursor)
  1103. */
  1104. static void
  1105. tty3270_erase_line(struct tty3270 *tp, int mode)
  1106. {
  1107. struct tty3270_line *line;
  1108. struct tty3270_cell *cell;
  1109. int i;
  1110. line = tp->screen + tp->cy;
  1111. if (mode == 0)
  1112. line->len = tp->cx;
  1113. else if (mode == 1) {
  1114. for (i = 0; i < tp->cx; i++) {
  1115. cell = line->cells + i;
  1116. cell->character = ' ';
  1117. cell->highlight = TAX_RESET;
  1118. cell->f_color = TAC_RESET;
  1119. }
  1120. if (line->len <= tp->cx)
  1121. line->len = tp->cx + 1;
  1122. } else if (mode == 2)
  1123. line->len = 0;
  1124. tty3270_convert_line(tp, tp->cy);
  1125. }
  1126. /*
  1127. * Erase display, 3 different cases:
  1128. * Esc [ 0 J Erase from current position to bottom of screen inclusive
  1129. * Esc [ 1 J Erase from top of screen to current position inclusive
  1130. * Esc [ 2 J Erase entire screen (without moving the cursor)
  1131. */
  1132. static void
  1133. tty3270_erase_display(struct tty3270 *tp, int mode)
  1134. {
  1135. int i;
  1136. if (mode == 0) {
  1137. tty3270_erase_line(tp, 0);
  1138. for (i = tp->cy + 1; i < tp->view.rows - 2; i++) {
  1139. tp->screen[i].len = 0;
  1140. tty3270_convert_line(tp, i);
  1141. }
  1142. } else if (mode == 1) {
  1143. for (i = 0; i < tp->cy; i++) {
  1144. tp->screen[i].len = 0;
  1145. tty3270_convert_line(tp, i);
  1146. }
  1147. tty3270_erase_line(tp, 1);
  1148. } else if (mode == 2) {
  1149. for (i = 0; i < tp->view.rows - 2; i++) {
  1150. tp->screen[i].len = 0;
  1151. tty3270_convert_line(tp, i);
  1152. }
  1153. }
  1154. tty3270_rebuild_update(tp);
  1155. }
  1156. /*
  1157. * Set attributes found in an escape sequence.
  1158. * Esc [ <attr> ; <attr> ; ... m
  1159. */
  1160. static void
  1161. tty3270_set_attributes(struct tty3270 *tp)
  1162. {
  1163. static unsigned char f_colors[] = {
  1164. TAC_DEFAULT, TAC_RED, TAC_GREEN, TAC_YELLOW, TAC_BLUE,
  1165. TAC_PINK, TAC_TURQ, TAC_WHITE, 0, TAC_DEFAULT
  1166. };
  1167. int i, attr;
  1168. for (i = 0; i <= tp->esc_npar; i++) {
  1169. attr = tp->esc_par[i];
  1170. switch (attr) {
  1171. case 0: /* Reset */
  1172. tp->highlight = TAX_RESET;
  1173. tp->f_color = TAC_RESET;
  1174. break;
  1175. /* Highlight. */
  1176. case 4: /* Start underlining. */
  1177. tp->highlight = TAX_UNDER;
  1178. break;
  1179. case 5: /* Start blink. */
  1180. tp->highlight = TAX_BLINK;
  1181. break;
  1182. case 7: /* Start reverse. */
  1183. tp->highlight = TAX_REVER;
  1184. break;
  1185. case 24: /* End underlining */
  1186. if (tp->highlight == TAX_UNDER)
  1187. tp->highlight = TAX_RESET;
  1188. break;
  1189. case 25: /* End blink. */
  1190. if (tp->highlight == TAX_BLINK)
  1191. tp->highlight = TAX_RESET;
  1192. break;
  1193. case 27: /* End reverse. */
  1194. if (tp->highlight == TAX_REVER)
  1195. tp->highlight = TAX_RESET;
  1196. break;
  1197. /* Foreground color. */
  1198. case 30: /* Black */
  1199. case 31: /* Red */
  1200. case 32: /* Green */
  1201. case 33: /* Yellow */
  1202. case 34: /* Blue */
  1203. case 35: /* Magenta */
  1204. case 36: /* Cyan */
  1205. case 37: /* White */
  1206. case 39: /* Black */
  1207. tp->f_color = f_colors[attr - 30];
  1208. break;
  1209. }
  1210. }
  1211. }
  1212. static inline int
  1213. tty3270_getpar(struct tty3270 *tp, int ix)
  1214. {
  1215. return (tp->esc_par[ix] > 0) ? tp->esc_par[ix] : 1;
  1216. }
  1217. static void
  1218. tty3270_goto_xy(struct tty3270 *tp, int cx, int cy)
  1219. {
  1220. tp->cx = min_t(int, tp->view.cols - 1, max_t(int, 0, cx));
  1221. cy = min_t(int, tp->view.rows - 3, max_t(int, 0, cy));
  1222. if (cy != tp->cy) {
  1223. tty3270_convert_line(tp, tp->cy);
  1224. tp->cy = cy;
  1225. }
  1226. }
  1227. /*
  1228. * Process escape sequences. Known sequences:
  1229. * Esc 7 Save Cursor Position
  1230. * Esc 8 Restore Cursor Position
  1231. * Esc [ Pn ; Pn ; .. m Set attributes
  1232. * Esc [ Pn ; Pn H Cursor Position
  1233. * Esc [ Pn ; Pn f Cursor Position
  1234. * Esc [ Pn A Cursor Up
  1235. * Esc [ Pn B Cursor Down
  1236. * Esc [ Pn C Cursor Forward
  1237. * Esc [ Pn D Cursor Backward
  1238. * Esc [ Pn G Cursor Horizontal Absolute
  1239. * Esc [ Pn X Erase Characters
  1240. * Esc [ Ps J Erase in Display
  1241. * Esc [ Ps K Erase in Line
  1242. * // FIXME: add all the new ones.
  1243. *
  1244. * Pn is a numeric parameter, a string of zero or more decimal digits.
  1245. * Ps is a selective parameter.
  1246. */
  1247. static void
  1248. tty3270_escape_sequence(struct tty3270 *tp, char ch)
  1249. {
  1250. enum { ESnormal, ESesc, ESsquare, ESgetpars };
  1251. if (tp->esc_state == ESnormal) {
  1252. if (ch == 0x1b)
  1253. /* Starting new escape sequence. */
  1254. tp->esc_state = ESesc;
  1255. return;
  1256. }
  1257. if (tp->esc_state == ESesc) {
  1258. tp->esc_state = ESnormal;
  1259. switch (ch) {
  1260. case '[':
  1261. tp->esc_state = ESsquare;
  1262. break;
  1263. case 'E':
  1264. tty3270_cr(tp);
  1265. tty3270_lf(tp);
  1266. break;
  1267. case 'M':
  1268. tty3270_ri(tp);
  1269. break;
  1270. case 'D':
  1271. tty3270_lf(tp);
  1272. break;
  1273. case 'Z': /* Respond ID. */
  1274. kbd_puts_queue(tp->tty, "\033[?6c");
  1275. break;
  1276. case '7': /* Save cursor position. */
  1277. tp->saved_cx = tp->cx;
  1278. tp->saved_cy = tp->cy;
  1279. tp->saved_highlight = tp->highlight;
  1280. tp->saved_f_color = tp->f_color;
  1281. break;
  1282. case '8': /* Restore cursor position. */
  1283. tty3270_convert_line(tp, tp->cy);
  1284. tty3270_goto_xy(tp, tp->saved_cx, tp->saved_cy);
  1285. tp->highlight = tp->saved_highlight;
  1286. tp->f_color = tp->saved_f_color;
  1287. break;
  1288. case 'c': /* Reset terminal. */
  1289. tp->cx = tp->saved_cx = 0;
  1290. tp->cy = tp->saved_cy = 0;
  1291. tp->highlight = tp->saved_highlight = TAX_RESET;
  1292. tp->f_color = tp->saved_f_color = TAC_RESET;
  1293. tty3270_erase_display(tp, 2);
  1294. break;
  1295. }
  1296. return;
  1297. }
  1298. if (tp->esc_state == ESsquare) {
  1299. tp->esc_state = ESgetpars;
  1300. memset(tp->esc_par, 0, sizeof(tp->esc_par));
  1301. tp->esc_npar = 0;
  1302. tp->esc_ques = (ch == '?');
  1303. if (tp->esc_ques)
  1304. return;
  1305. }
  1306. if (tp->esc_state == ESgetpars) {
  1307. if (ch == ';' && tp->esc_npar < ESCAPE_NPAR - 1) {
  1308. tp->esc_npar++;
  1309. return;
  1310. }
  1311. if (ch >= '0' && ch <= '9') {
  1312. tp->esc_par[tp->esc_npar] *= 10;
  1313. tp->esc_par[tp->esc_npar] += ch - '0';
  1314. return;
  1315. }
  1316. }
  1317. tp->esc_state = ESnormal;
  1318. if (ch == 'n' && !tp->esc_ques) {
  1319. if (tp->esc_par[0] == 5) /* Status report. */
  1320. kbd_puts_queue(tp->tty, "\033[0n");
  1321. else if (tp->esc_par[0] == 6) { /* Cursor report. */
  1322. char buf[40];
  1323. sprintf(buf, "\033[%d;%dR", tp->cy + 1, tp->cx + 1);
  1324. kbd_puts_queue(tp->tty, buf);
  1325. }
  1326. return;
  1327. }
  1328. if (tp->esc_ques)
  1329. return;
  1330. switch (ch) {
  1331. case 'm':
  1332. tty3270_set_attributes(tp);
  1333. break;
  1334. case 'H': /* Set cursor position. */
  1335. case 'f':
  1336. tty3270_goto_xy(tp, tty3270_getpar(tp, 1) - 1,
  1337. tty3270_getpar(tp, 0) - 1);
  1338. break;
  1339. case 'd': /* Set y position. */
  1340. tty3270_goto_xy(tp, tp->cx, tty3270_getpar(tp, 0) - 1);
  1341. break;
  1342. case 'A': /* Cursor up. */
  1343. case 'F':
  1344. tty3270_goto_xy(tp, tp->cx, tp->cy - tty3270_getpar(tp, 0));
  1345. break;
  1346. case 'B': /* Cursor down. */
  1347. case 'e':
  1348. case 'E':
  1349. tty3270_goto_xy(tp, tp->cx, tp->cy + tty3270_getpar(tp, 0));
  1350. break;
  1351. case 'C': /* Cursor forward. */
  1352. case 'a':
  1353. tty3270_goto_xy(tp, tp->cx + tty3270_getpar(tp, 0), tp->cy);
  1354. break;
  1355. case 'D': /* Cursor backward. */
  1356. tty3270_goto_xy(tp, tp->cx - tty3270_getpar(tp, 0), tp->cy);
  1357. break;
  1358. case 'G': /* Set x position. */
  1359. case '`':
  1360. tty3270_goto_xy(tp, tty3270_getpar(tp, 0), tp->cy);
  1361. break;
  1362. case 'X': /* Erase Characters. */
  1363. tty3270_erase_characters(tp, tty3270_getpar(tp, 0));
  1364. break;
  1365. case 'J': /* Erase display. */
  1366. tty3270_erase_display(tp, tp->esc_par[0]);
  1367. break;
  1368. case 'K': /* Erase line. */
  1369. tty3270_erase_line(tp, tp->esc_par[0]);
  1370. break;
  1371. case 'P': /* Delete characters. */
  1372. tty3270_delete_characters(tp, tty3270_getpar(tp, 0));
  1373. break;
  1374. case '@': /* Insert characters. */
  1375. tty3270_insert_characters(tp, tty3270_getpar(tp, 0));
  1376. break;
  1377. case 's': /* Save cursor position. */
  1378. tp->saved_cx = tp->cx;
  1379. tp->saved_cy = tp->cy;
  1380. tp->saved_highlight = tp->highlight;
  1381. tp->saved_f_color = tp->f_color;
  1382. break;
  1383. case 'u': /* Restore cursor position. */
  1384. tty3270_convert_line(tp, tp->cy);
  1385. tty3270_goto_xy(tp, tp->saved_cx, tp->saved_cy);
  1386. tp->highlight = tp->saved_highlight;
  1387. tp->f_color = tp->saved_f_color;
  1388. break;
  1389. }
  1390. }
  1391. /*
  1392. * String write routine for 3270 ttys
  1393. */
  1394. static void
  1395. tty3270_do_write(struct tty3270 *tp, const unsigned char *buf, int count)
  1396. {
  1397. int i_msg, i;
  1398. spin_lock_bh(&tp->view.lock);
  1399. for (i_msg = 0; !tp->tty->stopped && i_msg < count; i_msg++) {
  1400. if (tp->esc_state != 0) {
  1401. /* Continue escape sequence. */
  1402. tty3270_escape_sequence(tp, buf[i_msg]);
  1403. continue;
  1404. }
  1405. switch (buf[i_msg]) {
  1406. case 0x07: /* '\a' -- Alarm */
  1407. tp->wcc |= TW_PLUSALARM;
  1408. break;
  1409. case 0x08: /* Backspace. */
  1410. if (tp->cx > 0) {
  1411. tp->cx--;
  1412. tty3270_put_character(tp, ' ');
  1413. }
  1414. break;
  1415. case 0x09: /* '\t' -- Tabulate */
  1416. for (i = tp->cx % 8; i < 8; i++) {
  1417. if (tp->cx >= tp->view.cols) {
  1418. tty3270_cr(tp);
  1419. tty3270_lf(tp);
  1420. break;
  1421. }
  1422. tty3270_put_character(tp, ' ');
  1423. tp->cx++;
  1424. }
  1425. break;
  1426. case 0x0a: /* '\n' -- New Line */
  1427. tty3270_cr(tp);
  1428. tty3270_lf(tp);
  1429. break;
  1430. case 0x0c: /* '\f' -- Form Feed */
  1431. tty3270_erase_display(tp, 2);
  1432. tp->cx = tp->cy = 0;
  1433. break;
  1434. case 0x0d: /* '\r' -- Carriage Return */
  1435. tp->cx = 0;
  1436. break;
  1437. case 0x0f: /* SuSE "exit alternate mode" */
  1438. break;
  1439. case 0x1b: /* Start escape sequence. */
  1440. tty3270_escape_sequence(tp, buf[i_msg]);
  1441. break;
  1442. default: /* Insert normal character. */
  1443. if (tp->cx >= tp->view.cols) {
  1444. tty3270_cr(tp);
  1445. tty3270_lf(tp);
  1446. }
  1447. tty3270_put_character(tp, buf[i_msg]);
  1448. tp->cx++;
  1449. break;
  1450. }
  1451. }
  1452. /* Convert current line to 3270 data fragment. */
  1453. tty3270_convert_line(tp, tp->cy);
  1454. /* Setup timer to update display after 1/10 second */
  1455. if (!timer_pending(&tp->timer))
  1456. tty3270_set_timer(tp, HZ/10);
  1457. spin_unlock_bh(&tp->view.lock);
  1458. }
  1459. /*
  1460. * String write routine for 3270 ttys
  1461. */
  1462. static int
  1463. tty3270_write(struct tty_struct * tty,
  1464. const unsigned char *buf, int count)
  1465. {
  1466. struct tty3270 *tp;
  1467. tp = tty->driver_data;
  1468. if (!tp)
  1469. return 0;
  1470. if (tp->char_count > 0) {
  1471. tty3270_do_write(tp, tp->char_buf, tp->char_count);
  1472. tp->char_count = 0;
  1473. }
  1474. tty3270_do_write(tp, buf, count);
  1475. return count;
  1476. }
  1477. /*
  1478. * Put single characters to the ttys character buffer
  1479. */
  1480. static void
  1481. tty3270_put_char(struct tty_struct *tty, unsigned char ch)
  1482. {
  1483. struct tty3270 *tp;
  1484. tp = tty->driver_data;
  1485. if (!tp)
  1486. return;
  1487. if (tp->char_count < TTY3270_CHAR_BUF_SIZE)
  1488. tp->char_buf[tp->char_count++] = ch;
  1489. }
  1490. /*
  1491. * Flush all characters from the ttys characeter buffer put there
  1492. * by tty3270_put_char.
  1493. */
  1494. static void
  1495. tty3270_flush_chars(struct tty_struct *tty)
  1496. {
  1497. struct tty3270 *tp;
  1498. tp = tty->driver_data;
  1499. if (!tp)
  1500. return;
  1501. if (tp->char_count > 0) {
  1502. tty3270_do_write(tp, tp->char_buf, tp->char_count);
  1503. tp->char_count = 0;
  1504. }
  1505. }
  1506. /*
  1507. * Returns the number of characters in the output buffer. This is
  1508. * used in tty_wait_until_sent to wait until all characters have
  1509. * appeared on the screen.
  1510. */
  1511. static int
  1512. tty3270_chars_in_buffer(struct tty_struct *tty)
  1513. {
  1514. return 0;
  1515. }
  1516. static void
  1517. tty3270_flush_buffer(struct tty_struct *tty)
  1518. {
  1519. }
  1520. /*
  1521. * Check for visible/invisible input switches
  1522. */
  1523. static void
  1524. tty3270_set_termios(struct tty_struct *tty, struct termios *old)
  1525. {
  1526. struct tty3270 *tp;
  1527. int new;
  1528. tp = tty->driver_data;
  1529. if (!tp)
  1530. return;
  1531. spin_lock_bh(&tp->view.lock);
  1532. if (L_ICANON(tty)) {
  1533. new = L_ECHO(tty) ? TF_INPUT: TF_INPUTN;
  1534. if (new != tp->inattr) {
  1535. tp->inattr = new;
  1536. tty3270_update_prompt(tp, 0, 0);
  1537. tty3270_set_timer(tp, 1);
  1538. }
  1539. }
  1540. spin_unlock_bh(&tp->view.lock);
  1541. }
  1542. /*
  1543. * Disable reading from a 3270 tty
  1544. */
  1545. static void
  1546. tty3270_throttle(struct tty_struct * tty)
  1547. {
  1548. struct tty3270 *tp;
  1549. tp = tty->driver_data;
  1550. if (!tp)
  1551. return;
  1552. tp->throttle = 1;
  1553. }
  1554. /*
  1555. * Enable reading from a 3270 tty
  1556. */
  1557. static void
  1558. tty3270_unthrottle(struct tty_struct * tty)
  1559. {
  1560. struct tty3270 *tp;
  1561. tp = tty->driver_data;
  1562. if (!tp)
  1563. return;
  1564. tp->throttle = 0;
  1565. if (tp->attn)
  1566. tty3270_issue_read(tp, 1);
  1567. }
  1568. /*
  1569. * Hang up the tty device.
  1570. */
  1571. static void
  1572. tty3270_hangup(struct tty_struct *tty)
  1573. {
  1574. // FIXME: implement
  1575. }
  1576. static void
  1577. tty3270_wait_until_sent(struct tty_struct *tty, int timeout)
  1578. {
  1579. }
  1580. static int
  1581. tty3270_ioctl(struct tty_struct *tty, struct file *file,
  1582. unsigned int cmd, unsigned long arg)
  1583. {
  1584. struct tty3270 *tp;
  1585. tp = tty->driver_data;
  1586. if (!tp)
  1587. return -ENODEV;
  1588. if (tty->flags & (1 << TTY_IO_ERROR))
  1589. return -EIO;
  1590. return kbd_ioctl(tp->kbd, file, cmd, arg);
  1591. }
  1592. static struct tty_operations tty3270_ops = {
  1593. .open = tty3270_open,
  1594. .close = tty3270_close,
  1595. .write = tty3270_write,
  1596. .put_char = tty3270_put_char,
  1597. .flush_chars = tty3270_flush_chars,
  1598. .write_room = tty3270_write_room,
  1599. .chars_in_buffer = tty3270_chars_in_buffer,
  1600. .flush_buffer = tty3270_flush_buffer,
  1601. .throttle = tty3270_throttle,
  1602. .unthrottle = tty3270_unthrottle,
  1603. .hangup = tty3270_hangup,
  1604. .wait_until_sent = tty3270_wait_until_sent,
  1605. .ioctl = tty3270_ioctl,
  1606. .set_termios = tty3270_set_termios
  1607. };
  1608. void
  1609. tty3270_notifier(int index, int active)
  1610. {
  1611. if (active)
  1612. tty_register_device(tty3270_driver, index, 0);
  1613. else
  1614. tty_unregister_device(tty3270_driver, index);
  1615. }
  1616. /*
  1617. * 3270 tty registration code called from tty_init().
  1618. * Most kernel services (incl. kmalloc) are available at this poimt.
  1619. */
  1620. int __init
  1621. tty3270_init(void)
  1622. {
  1623. struct tty_driver *driver;
  1624. int ret;
  1625. driver = alloc_tty_driver(RAW3270_MAXDEVS);
  1626. if (!driver)
  1627. return -ENOMEM;
  1628. /*
  1629. * Initialize the tty_driver structure
  1630. * Entries in tty3270_driver that are NOT initialized:
  1631. * proc_entry, set_termios, flush_buffer, set_ldisc, write_proc
  1632. */
  1633. driver->owner = THIS_MODULE;
  1634. driver->devfs_name = "ttyTUB/";
  1635. driver->driver_name = "ttyTUB";
  1636. driver->name = "ttyTUB";
  1637. driver->major = IBM_TTY3270_MAJOR;
  1638. driver->minor_start = RAW3270_FIRSTMINOR;
  1639. driver->type = TTY_DRIVER_TYPE_SYSTEM;
  1640. driver->subtype = SYSTEM_TYPE_TTY;
  1641. driver->init_termios = tty_std_termios;
  1642. driver->flags = TTY_DRIVER_RESET_TERMIOS | TTY_DRIVER_NO_DEVFS;
  1643. tty_set_operations(driver, &tty3270_ops);
  1644. ret = tty_register_driver(driver);
  1645. if (ret) {
  1646. printk(KERN_ERR "tty3270 registration failed with %d\n", ret);
  1647. put_tty_driver(driver);
  1648. return ret;
  1649. }
  1650. tty3270_driver = driver;
  1651. ret = raw3270_register_notifier(tty3270_notifier);
  1652. if (ret) {
  1653. printk(KERN_ERR "tty3270 notifier registration failed "
  1654. "with %d\n", ret);
  1655. put_tty_driver(driver);
  1656. return ret;
  1657. }
  1658. return 0;
  1659. }
  1660. static void __exit
  1661. tty3270_exit(void)
  1662. {
  1663. struct tty_driver *driver;
  1664. raw3270_unregister_notifier(tty3270_notifier);
  1665. driver = tty3270_driver;
  1666. tty3270_driver = 0;
  1667. tty_unregister_driver(driver);
  1668. tty3270_del_views();
  1669. }
  1670. MODULE_LICENSE("GPL");
  1671. MODULE_ALIAS_CHARDEV_MAJOR(IBM_TTY3270_MAJOR);
  1672. module_init(tty3270_init);
  1673. module_exit(tty3270_exit);