io_ti.c 83 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085
  1. /*
  2. * Edgeport USB Serial Converter driver
  3. *
  4. * Copyright (C) 2000-2002 Inside Out Networks, All rights reserved.
  5. * Copyright (C) 2001-2002 Greg Kroah-Hartman <greg@kroah.com>
  6. *
  7. * This program is free software; you can redistribute it and/or modify
  8. * it under the terms of the GNU General Public License as published by
  9. * the Free Software Foundation; either version 2 of the License, or
  10. * (at your option) any later version.
  11. *
  12. * Supports the following devices:
  13. * EP/1 EP/2 EP/4 EP/21 EP/22 EP/221 EP/42 EP/421 WATCHPORT
  14. *
  15. * For questions or problems with this driver, contact Inside Out
  16. * Networks technical support, or Peter Berger <pberger@brimson.com>,
  17. * or Al Borchers <alborchers@steinerpoint.com>.
  18. *
  19. * Version history:
  20. *
  21. * July 11, 2002 Removed 4 port device structure since all TI UMP
  22. * chips have only 2 ports
  23. * David Iacovelli (davidi@ionetworks.com)
  24. *
  25. */
  26. #include <linux/kernel.h>
  27. #include <linux/jiffies.h>
  28. #include <linux/errno.h>
  29. #include <linux/init.h>
  30. #include <linux/slab.h>
  31. #include <linux/tty.h>
  32. #include <linux/tty_driver.h>
  33. #include <linux/tty_flip.h>
  34. #include <linux/module.h>
  35. #include <linux/spinlock.h>
  36. #include <linux/serial.h>
  37. #include <linux/ioctl.h>
  38. #include <asm/uaccess.h>
  39. #include <asm/semaphore.h>
  40. #include <linux/usb.h>
  41. #include <linux/usb/serial.h>
  42. #include "io_16654.h"
  43. #include "io_usbvend.h"
  44. #include "io_ti.h"
  45. /*
  46. * Version Information
  47. */
  48. #define DRIVER_VERSION "v0.7"
  49. #define DRIVER_AUTHOR "Greg Kroah-Hartman <greg@kroah.com> and David Iacovelli"
  50. #define DRIVER_DESC "Edgeport USB Serial Driver"
  51. /* firmware image code */
  52. #define IMAGE_VERSION_NAME PagableOperationalCodeImageVersion
  53. #define IMAGE_ARRAY_NAME PagableOperationalCodeImage
  54. #define IMAGE_SIZE PagableOperationalCodeSize
  55. #include "io_fw_down3.h" /* Define array OperationalCodeImage[] */
  56. #define EPROM_PAGE_SIZE 64
  57. struct edgeport_uart_buf_desc {
  58. __u32 count; // Number of bytes currently in buffer
  59. };
  60. /* different hardware types */
  61. #define HARDWARE_TYPE_930 0
  62. #define HARDWARE_TYPE_TIUMP 1
  63. // IOCTL_PRIVATE_TI_GET_MODE Definitions
  64. #define TI_MODE_CONFIGURING 0 // Device has not entered start device
  65. #define TI_MODE_BOOT 1 // Staying in boot mode
  66. #define TI_MODE_DOWNLOAD 2 // Made it to download mode
  67. #define TI_MODE_TRANSITIONING 3 // Currently in boot mode but transitioning to download mode
  68. /* read urb state */
  69. #define EDGE_READ_URB_RUNNING 0
  70. #define EDGE_READ_URB_STOPPING 1
  71. #define EDGE_READ_URB_STOPPED 2
  72. #define EDGE_LOW_LATENCY 1
  73. #define EDGE_CLOSING_WAIT 4000 /* in .01 sec */
  74. #define EDGE_OUT_BUF_SIZE 1024
  75. /* Product information read from the Edgeport */
  76. struct product_info
  77. {
  78. int TiMode; // Current TI Mode
  79. __u8 hardware_type; // Type of hardware
  80. } __attribute__((packed));
  81. /* circular buffer */
  82. struct edge_buf {
  83. unsigned int buf_size;
  84. char *buf_buf;
  85. char *buf_get;
  86. char *buf_put;
  87. };
  88. struct edgeport_port {
  89. __u16 uart_base;
  90. __u16 dma_address;
  91. __u8 shadow_msr;
  92. __u8 shadow_mcr;
  93. __u8 shadow_lsr;
  94. __u8 lsr_mask;
  95. __u32 ump_read_timeout; /* Number of miliseconds the UMP will
  96. wait without data before completing
  97. a read short */
  98. int baud_rate;
  99. int close_pending;
  100. int lsr_event;
  101. struct edgeport_uart_buf_desc tx;
  102. struct async_icount icount;
  103. wait_queue_head_t delta_msr_wait; /* for handling sleeping while
  104. waiting for msr change to
  105. happen */
  106. struct edgeport_serial *edge_serial;
  107. struct usb_serial_port *port;
  108. __u8 bUartMode; /* Port type, 0: RS232, etc. */
  109. spinlock_t ep_lock;
  110. int ep_read_urb_state;
  111. int ep_write_urb_in_use;
  112. struct edge_buf *ep_out_buf;
  113. };
  114. struct edgeport_serial {
  115. struct product_info product_info;
  116. u8 TI_I2C_Type; // Type of I2C in UMP
  117. u8 TiReadI2C; // Set to TRUE if we have read the I2c in Boot Mode
  118. struct semaphore es_sem;
  119. int num_ports_open;
  120. struct usb_serial *serial;
  121. };
  122. /* Devices that this driver supports */
  123. static struct usb_device_id edgeport_1port_id_table [] = {
  124. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_1) },
  125. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_TI3410_EDGEPORT_1) },
  126. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_TI3410_EDGEPORT_1I) },
  127. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_PROXIMITY) },
  128. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_MOTION) },
  129. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_MOISTURE) },
  130. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_TEMPERATURE) },
  131. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_HUMIDITY) },
  132. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_POWER) },
  133. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_LIGHT) },
  134. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_RADIATION) },
  135. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_DISTANCE) },
  136. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_ACCELERATION) },
  137. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_PROX_DIST) },
  138. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_PLUS_PWR_HP4CD) },
  139. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_PLUS_PWR_PCI) },
  140. { }
  141. };
  142. static struct usb_device_id edgeport_2port_id_table [] = {
  143. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_2) },
  144. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_2C) },
  145. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_2I) },
  146. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_421) },
  147. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_21) },
  148. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_42) },
  149. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_4) },
  150. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_4I) },
  151. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_22I) },
  152. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_221C) },
  153. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_22C) },
  154. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_21C) },
  155. // The 4-port shows up as two 2-port devices
  156. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_4S) },
  157. { }
  158. };
  159. /* Devices that this driver supports */
  160. static struct usb_device_id id_table_combined [] = {
  161. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_1) },
  162. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_TI3410_EDGEPORT_1) },
  163. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_TI3410_EDGEPORT_1I) },
  164. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_PROXIMITY) },
  165. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_MOTION) },
  166. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_MOISTURE) },
  167. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_TEMPERATURE) },
  168. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_HUMIDITY) },
  169. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_POWER) },
  170. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_LIGHT) },
  171. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_RADIATION) },
  172. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_DISTANCE) },
  173. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_ACCELERATION) },
  174. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_PROX_DIST) },
  175. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_PLUS_PWR_HP4CD) },
  176. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_PLUS_PWR_PCI) },
  177. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_2) },
  178. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_2C) },
  179. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_2I) },
  180. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_421) },
  181. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_21) },
  182. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_42) },
  183. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_4) },
  184. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_4I) },
  185. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_22I) },
  186. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_221C) },
  187. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_22C) },
  188. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_21C) },
  189. { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_4S) },
  190. { }
  191. };
  192. MODULE_DEVICE_TABLE (usb, id_table_combined);
  193. static struct usb_driver io_driver = {
  194. .name = "io_ti",
  195. .probe = usb_serial_probe,
  196. .disconnect = usb_serial_disconnect,
  197. .id_table = id_table_combined,
  198. .no_dynamic_id = 1,
  199. };
  200. static struct EDGE_FIRMWARE_VERSION_INFO OperationalCodeImageVersion;
  201. static int debug;
  202. static int TIStayInBootMode = 0;
  203. static int low_latency = EDGE_LOW_LATENCY;
  204. static int closing_wait = EDGE_CLOSING_WAIT;
  205. static int ignore_cpu_rev = 0;
  206. static void edge_tty_recv(struct device *dev, struct tty_struct *tty, unsigned char *data, int length);
  207. static void stop_read(struct edgeport_port *edge_port);
  208. static int restart_read(struct edgeport_port *edge_port);
  209. static void edge_set_termios (struct usb_serial_port *port, struct termios *old_termios);
  210. static void edge_send(struct usb_serial_port *port);
  211. /* circular buffer */
  212. static struct edge_buf *edge_buf_alloc(unsigned int size);
  213. static void edge_buf_free(struct edge_buf *eb);
  214. static void edge_buf_clear(struct edge_buf *eb);
  215. static unsigned int edge_buf_data_avail(struct edge_buf *eb);
  216. static unsigned int edge_buf_space_avail(struct edge_buf *eb);
  217. static unsigned int edge_buf_put(struct edge_buf *eb, const char *buf,
  218. unsigned int count);
  219. static unsigned int edge_buf_get(struct edge_buf *eb, char *buf,
  220. unsigned int count);
  221. static int TIReadVendorRequestSync (struct usb_device *dev,
  222. __u8 request,
  223. __u16 value,
  224. __u16 index,
  225. u8 *data,
  226. int size)
  227. {
  228. int status;
  229. status = usb_control_msg (dev,
  230. usb_rcvctrlpipe(dev, 0),
  231. request,
  232. (USB_TYPE_VENDOR |
  233. USB_RECIP_DEVICE |
  234. USB_DIR_IN),
  235. value,
  236. index,
  237. data,
  238. size,
  239. 1000);
  240. if (status < 0)
  241. return status;
  242. if (status != size) {
  243. dbg ("%s - wanted to write %d, but only wrote %d",
  244. __FUNCTION__, size, status);
  245. return -ECOMM;
  246. }
  247. return 0;
  248. }
  249. static int TISendVendorRequestSync (struct usb_device *dev,
  250. __u8 request,
  251. __u16 value,
  252. __u16 index,
  253. u8 *data,
  254. int size)
  255. {
  256. int status;
  257. status = usb_control_msg (dev,
  258. usb_sndctrlpipe(dev, 0),
  259. request,
  260. (USB_TYPE_VENDOR |
  261. USB_RECIP_DEVICE |
  262. USB_DIR_OUT),
  263. value,
  264. index,
  265. data,
  266. size,
  267. 1000);
  268. if (status < 0)
  269. return status;
  270. if (status != size) {
  271. dbg ("%s - wanted to write %d, but only wrote %d",
  272. __FUNCTION__, size, status);
  273. return -ECOMM;
  274. }
  275. return 0;
  276. }
  277. static int TIWriteCommandSync (struct usb_device *dev, __u8 command,
  278. __u8 moduleid, __u16 value, u8 *data,
  279. int size)
  280. {
  281. return TISendVendorRequestSync (dev,
  282. command, // Request
  283. value, // wValue
  284. moduleid, // wIndex
  285. data, // TransferBuffer
  286. size); // TransferBufferLength
  287. }
  288. /* clear tx/rx buffers and fifo in TI UMP */
  289. static int TIPurgeDataSync (struct usb_serial_port *port, __u16 mask)
  290. {
  291. int port_number = port->number - port->serial->minor;
  292. dbg ("%s - port %d, mask %x", __FUNCTION__, port_number, mask);
  293. return TIWriteCommandSync (port->serial->dev,
  294. UMPC_PURGE_PORT,
  295. (__u8)(UMPM_UART1_PORT + port_number),
  296. mask,
  297. NULL,
  298. 0);
  299. }
  300. /**
  301. * TIReadDownloadMemory - Read edgeport memory from TI chip
  302. * @dev: usb device pointer
  303. * @start_address: Device CPU address at which to read
  304. * @length: Length of above data
  305. * @address_type: Can read both XDATA and I2C
  306. * @buffer: pointer to input data buffer
  307. */
  308. static int TIReadDownloadMemory(struct usb_device *dev, int start_address,
  309. int length, __u8 address_type, __u8 *buffer)
  310. {
  311. int status = 0;
  312. __u8 read_length;
  313. __be16 be_start_address;
  314. dbg ("%s - @ %x for %d", __FUNCTION__, start_address, length);
  315. /* Read in blocks of 64 bytes
  316. * (TI firmware can't handle more than 64 byte reads)
  317. */
  318. while (length) {
  319. if (length > 64)
  320. read_length= 64;
  321. else
  322. read_length = (__u8)length;
  323. if (read_length > 1) {
  324. dbg ("%s - @ %x for %d", __FUNCTION__,
  325. start_address, read_length);
  326. }
  327. be_start_address = cpu_to_be16 (start_address);
  328. status = TIReadVendorRequestSync (dev,
  329. UMPC_MEMORY_READ, // Request
  330. (__u16)address_type, // wValue (Address type)
  331. (__force __u16)be_start_address, // wIndex (Address to read)
  332. buffer, // TransferBuffer
  333. read_length); // TransferBufferLength
  334. if (status) {
  335. dbg ("%s - ERROR %x", __FUNCTION__, status);
  336. return status;
  337. }
  338. if (read_length > 1) {
  339. usb_serial_debug_data(debug, &dev->dev, __FUNCTION__,
  340. read_length, buffer);
  341. }
  342. /* Update pointers/length */
  343. start_address += read_length;
  344. buffer += read_length;
  345. length -= read_length;
  346. }
  347. return status;
  348. }
  349. static int TIReadRam (struct usb_device *dev, int start_address, int length, __u8 *buffer)
  350. {
  351. return TIReadDownloadMemory (dev,
  352. start_address,
  353. length,
  354. DTK_ADDR_SPACE_XDATA,
  355. buffer);
  356. }
  357. /* Read edgeport memory to a given block */
  358. static int TIReadBootMemory (struct edgeport_serial *serial, int start_address, int length, __u8 * buffer)
  359. {
  360. int status = 0;
  361. int i;
  362. for (i=0; i< length; i++) {
  363. status = TIReadVendorRequestSync (serial->serial->dev,
  364. UMPC_MEMORY_READ, // Request
  365. serial->TI_I2C_Type, // wValue (Address type)
  366. (__u16)(start_address+i), // wIndex
  367. &buffer[i], // TransferBuffer
  368. 0x01); // TransferBufferLength
  369. if (status) {
  370. dbg ("%s - ERROR %x", __FUNCTION__, status);
  371. return status;
  372. }
  373. }
  374. dbg ("%s - start_address = %x, length = %d", __FUNCTION__, start_address, length);
  375. usb_serial_debug_data(debug, &serial->serial->dev->dev, __FUNCTION__, length, buffer);
  376. serial->TiReadI2C = 1;
  377. return status;
  378. }
  379. /* Write given block to TI EPROM memory */
  380. static int TIWriteBootMemory (struct edgeport_serial *serial, int start_address, int length, __u8 *buffer)
  381. {
  382. int status = 0;
  383. int i;
  384. __u8 temp;
  385. /* Must do a read before write */
  386. if (!serial->TiReadI2C) {
  387. status = TIReadBootMemory(serial, 0, 1, &temp);
  388. if (status)
  389. return status;
  390. }
  391. for (i=0; i < length; ++i) {
  392. status = TISendVendorRequestSync (serial->serial->dev,
  393. UMPC_MEMORY_WRITE, // Request
  394. buffer[i], // wValue
  395. (__u16)(i+start_address), // wIndex
  396. NULL, // TransferBuffer
  397. 0); // TransferBufferLength
  398. if (status)
  399. return status;
  400. }
  401. dbg ("%s - start_sddr = %x, length = %d", __FUNCTION__, start_address, length);
  402. usb_serial_debug_data(debug, &serial->serial->dev->dev, __FUNCTION__, length, buffer);
  403. return status;
  404. }
  405. /* Write edgeport I2C memory to TI chip */
  406. static int TIWriteDownloadI2C (struct edgeport_serial *serial, int start_address, int length, __u8 address_type, __u8 *buffer)
  407. {
  408. int status = 0;
  409. int write_length;
  410. __be16 be_start_address;
  411. /* We can only send a maximum of 1 aligned byte page at a time */
  412. /* calulate the number of bytes left in the first page */
  413. write_length = EPROM_PAGE_SIZE - (start_address & (EPROM_PAGE_SIZE - 1));
  414. if (write_length > length)
  415. write_length = length;
  416. dbg ("%s - BytesInFirstPage Addr = %x, length = %d", __FUNCTION__, start_address, write_length);
  417. usb_serial_debug_data(debug, &serial->serial->dev->dev, __FUNCTION__, write_length, buffer);
  418. /* Write first page */
  419. be_start_address = cpu_to_be16 (start_address);
  420. status = TISendVendorRequestSync (serial->serial->dev,
  421. UMPC_MEMORY_WRITE, // Request
  422. (__u16)address_type, // wValue
  423. (__force __u16)be_start_address, // wIndex
  424. buffer, // TransferBuffer
  425. write_length);
  426. if (status) {
  427. dbg ("%s - ERROR %d", __FUNCTION__, status);
  428. return status;
  429. }
  430. length -= write_length;
  431. start_address += write_length;
  432. buffer += write_length;
  433. /* We should be aligned now -- can write max page size bytes at a time */
  434. while (length) {
  435. if (length > EPROM_PAGE_SIZE)
  436. write_length = EPROM_PAGE_SIZE;
  437. else
  438. write_length = length;
  439. dbg ("%s - Page Write Addr = %x, length = %d", __FUNCTION__, start_address, write_length);
  440. usb_serial_debug_data(debug, &serial->serial->dev->dev, __FUNCTION__, write_length, buffer);
  441. /* Write next page */
  442. be_start_address = cpu_to_be16 (start_address);
  443. status = TISendVendorRequestSync (serial->serial->dev,
  444. UMPC_MEMORY_WRITE, // Request
  445. (__u16)address_type, // wValue
  446. (__force __u16)be_start_address, // wIndex
  447. buffer, // TransferBuffer
  448. write_length); // TransferBufferLength
  449. if (status) {
  450. dev_err (&serial->serial->dev->dev, "%s - ERROR %d\n", __FUNCTION__, status);
  451. return status;
  452. }
  453. length -= write_length;
  454. start_address += write_length;
  455. buffer += write_length;
  456. }
  457. return status;
  458. }
  459. /* Examine the UMP DMA registers and LSR
  460. *
  461. * Check the MSBit of the X and Y DMA byte count registers.
  462. * A zero in this bit indicates that the TX DMA buffers are empty
  463. * then check the TX Empty bit in the UART.
  464. */
  465. static int TIIsTxActive (struct edgeport_port *port)
  466. {
  467. int status;
  468. struct out_endpoint_desc_block *oedb;
  469. __u8 *lsr;
  470. int bytes_left = 0;
  471. oedb = kmalloc (sizeof (* oedb), GFP_KERNEL);
  472. if (!oedb) {
  473. dev_err (&port->port->dev, "%s - out of memory\n", __FUNCTION__);
  474. return -ENOMEM;
  475. }
  476. lsr = kmalloc (1, GFP_KERNEL); /* Sigh, that's right, just one byte,
  477. as not all platforms can do DMA
  478. from stack */
  479. if (!lsr) {
  480. kfree(oedb);
  481. return -ENOMEM;
  482. }
  483. /* Read the DMA Count Registers */
  484. status = TIReadRam (port->port->serial->dev,
  485. port->dma_address,
  486. sizeof( *oedb),
  487. (void *)oedb);
  488. if (status)
  489. goto exit_is_tx_active;
  490. dbg ("%s - XByteCount 0x%X", __FUNCTION__, oedb->XByteCount);
  491. /* and the LSR */
  492. status = TIReadRam (port->port->serial->dev,
  493. port->uart_base + UMPMEM_OFFS_UART_LSR,
  494. 1,
  495. lsr);
  496. if (status)
  497. goto exit_is_tx_active;
  498. dbg ("%s - LSR = 0x%X", __FUNCTION__, *lsr);
  499. /* If either buffer has data or we are transmitting then return TRUE */
  500. if ((oedb->XByteCount & 0x80 ) != 0 )
  501. bytes_left += 64;
  502. if ((*lsr & UMP_UART_LSR_TX_MASK ) == 0 )
  503. bytes_left += 1;
  504. /* We return Not Active if we get any kind of error */
  505. exit_is_tx_active:
  506. dbg ("%s - return %d", __FUNCTION__, bytes_left );
  507. kfree(lsr);
  508. kfree(oedb);
  509. return bytes_left;
  510. }
  511. static void TIChasePort(struct edgeport_port *port, unsigned long timeout, int flush)
  512. {
  513. int baud_rate;
  514. struct tty_struct *tty = port->port->tty;
  515. wait_queue_t wait;
  516. unsigned long flags;
  517. if (!timeout)
  518. timeout = (HZ*EDGE_CLOSING_WAIT)/100;
  519. /* wait for data to drain from the buffer */
  520. spin_lock_irqsave(&port->ep_lock, flags);
  521. init_waitqueue_entry(&wait, current);
  522. add_wait_queue(&tty->write_wait, &wait);
  523. for (;;) {
  524. set_current_state(TASK_INTERRUPTIBLE);
  525. if (edge_buf_data_avail(port->ep_out_buf) == 0
  526. || timeout == 0 || signal_pending(current)
  527. || !usb_get_intfdata(port->port->serial->interface)) /* disconnect */
  528. break;
  529. spin_unlock_irqrestore(&port->ep_lock, flags);
  530. timeout = schedule_timeout(timeout);
  531. spin_lock_irqsave(&port->ep_lock, flags);
  532. }
  533. set_current_state(TASK_RUNNING);
  534. remove_wait_queue(&tty->write_wait, &wait);
  535. if (flush)
  536. edge_buf_clear(port->ep_out_buf);
  537. spin_unlock_irqrestore(&port->ep_lock, flags);
  538. /* wait for data to drain from the device */
  539. timeout += jiffies;
  540. while ((long)(jiffies - timeout) < 0 && !signal_pending(current)
  541. && usb_get_intfdata(port->port->serial->interface)) { /* not disconnected */
  542. if (!TIIsTxActive(port))
  543. break;
  544. msleep(10);
  545. }
  546. /* disconnected */
  547. if (!usb_get_intfdata(port->port->serial->interface))
  548. return;
  549. /* wait one more character time, based on baud rate */
  550. /* (TIIsTxActive doesn't seem to wait for the last byte) */
  551. if ((baud_rate=port->baud_rate) == 0)
  552. baud_rate = 50;
  553. msleep(max(1,(10000+baud_rate-1)/baud_rate));
  554. }
  555. static int TIChooseConfiguration (struct usb_device *dev)
  556. {
  557. // There may be multiple configurations on this device, in which case
  558. // we would need to read and parse all of them to find out which one
  559. // we want. However, we just support one config at this point,
  560. // configuration # 1, which is Config Descriptor 0.
  561. dbg ("%s - Number of Interfaces = %d", __FUNCTION__, dev->config->desc.bNumInterfaces);
  562. dbg ("%s - MAX Power = %d", __FUNCTION__, dev->config->desc.bMaxPower*2);
  563. if (dev->config->desc.bNumInterfaces != 1) {
  564. dev_err (&dev->dev, "%s - bNumInterfaces is not 1, ERROR!\n", __FUNCTION__);
  565. return -ENODEV;
  566. }
  567. return 0;
  568. }
  569. static int TIReadRom (struct edgeport_serial *serial, int start_address, int length, __u8 *buffer)
  570. {
  571. int status;
  572. if (serial->product_info.TiMode == TI_MODE_DOWNLOAD) {
  573. status = TIReadDownloadMemory (serial->serial->dev,
  574. start_address,
  575. length,
  576. serial->TI_I2C_Type,
  577. buffer);
  578. } else {
  579. status = TIReadBootMemory (serial,
  580. start_address,
  581. length,
  582. buffer);
  583. }
  584. return status;
  585. }
  586. static int TIWriteRom (struct edgeport_serial *serial, int start_address, int length, __u8 *buffer)
  587. {
  588. if (serial->product_info.TiMode == TI_MODE_BOOT)
  589. return TIWriteBootMemory (serial,
  590. start_address,
  591. length,
  592. buffer);
  593. if (serial->product_info.TiMode == TI_MODE_DOWNLOAD)
  594. return TIWriteDownloadI2C (serial,
  595. start_address,
  596. length,
  597. serial->TI_I2C_Type,
  598. buffer);
  599. return -EINVAL;
  600. }
  601. /* Read a descriptor header from I2C based on type */
  602. static int TIGetDescriptorAddress (struct edgeport_serial *serial, int desc_type, struct ti_i2c_desc *rom_desc)
  603. {
  604. int start_address;
  605. int status;
  606. /* Search for requested descriptor in I2C */
  607. start_address = 2;
  608. do {
  609. status = TIReadRom (serial,
  610. start_address,
  611. sizeof(struct ti_i2c_desc),
  612. (__u8 *)rom_desc );
  613. if (status)
  614. return 0;
  615. if (rom_desc->Type == desc_type)
  616. return start_address;
  617. start_address = start_address + sizeof(struct ti_i2c_desc) + rom_desc->Size;
  618. } while ((start_address < TI_MAX_I2C_SIZE) && rom_desc->Type);
  619. return 0;
  620. }
  621. /* Validate descriptor checksum */
  622. static int ValidChecksum(struct ti_i2c_desc *rom_desc, __u8 *buffer)
  623. {
  624. __u16 i;
  625. __u8 cs = 0;
  626. for (i=0; i < rom_desc->Size; i++) {
  627. cs = (__u8)(cs + buffer[i]);
  628. }
  629. if (cs != rom_desc->CheckSum) {
  630. dbg ("%s - Mismatch %x - %x", __FUNCTION__, rom_desc->CheckSum, cs);
  631. return -EINVAL;
  632. }
  633. return 0;
  634. }
  635. /* Make sure that the I2C image is good */
  636. static int TiValidateI2cImage (struct edgeport_serial *serial)
  637. {
  638. struct device *dev = &serial->serial->dev->dev;
  639. int status = 0;
  640. struct ti_i2c_desc *rom_desc;
  641. int start_address = 2;
  642. __u8 *buffer;
  643. __u16 ttype;
  644. rom_desc = kmalloc (sizeof (*rom_desc), GFP_KERNEL);
  645. if (!rom_desc) {
  646. dev_err (dev, "%s - out of memory\n", __FUNCTION__);
  647. return -ENOMEM;
  648. }
  649. buffer = kmalloc (TI_MAX_I2C_SIZE, GFP_KERNEL);
  650. if (!buffer) {
  651. dev_err (dev, "%s - out of memory when allocating buffer\n", __FUNCTION__);
  652. kfree (rom_desc);
  653. return -ENOMEM;
  654. }
  655. // Read the first byte (Signature0) must be 0x52 or 0x10
  656. status = TIReadRom (serial, 0, 1, buffer);
  657. if (status)
  658. goto ExitTiValidateI2cImage;
  659. if (*buffer != UMP5152 && *buffer != UMP3410) {
  660. dev_err (dev, "%s - invalid buffer signature\n", __FUNCTION__);
  661. status = -ENODEV;
  662. goto ExitTiValidateI2cImage;
  663. }
  664. do {
  665. // Validate the I2C
  666. status = TIReadRom (serial,
  667. start_address,
  668. sizeof(struct ti_i2c_desc),
  669. (__u8 *)rom_desc);
  670. if (status)
  671. break;
  672. if ((start_address + sizeof(struct ti_i2c_desc) + rom_desc->Size) > TI_MAX_I2C_SIZE) {
  673. status = -ENODEV;
  674. dbg ("%s - structure too big, erroring out.", __FUNCTION__);
  675. break;
  676. }
  677. dbg ("%s Type = 0x%x", __FUNCTION__, rom_desc->Type);
  678. // Skip type 2 record
  679. ttype = rom_desc->Type & 0x0f;
  680. if ( ttype != I2C_DESC_TYPE_FIRMWARE_BASIC
  681. && ttype != I2C_DESC_TYPE_FIRMWARE_AUTO ) {
  682. // Read the descriptor data
  683. status = TIReadRom(serial,
  684. start_address+sizeof(struct ti_i2c_desc),
  685. rom_desc->Size,
  686. buffer);
  687. if (status)
  688. break;
  689. status = ValidChecksum(rom_desc, buffer);
  690. if (status)
  691. break;
  692. }
  693. start_address = start_address + sizeof(struct ti_i2c_desc) + rom_desc->Size;
  694. } while ((rom_desc->Type != I2C_DESC_TYPE_ION) && (start_address < TI_MAX_I2C_SIZE));
  695. if ((rom_desc->Type != I2C_DESC_TYPE_ION) || (start_address > TI_MAX_I2C_SIZE))
  696. status = -ENODEV;
  697. ExitTiValidateI2cImage:
  698. kfree (buffer);
  699. kfree (rom_desc);
  700. return status;
  701. }
  702. static int TIReadManufDescriptor (struct edgeport_serial *serial, __u8 *buffer)
  703. {
  704. int status;
  705. int start_address;
  706. struct ti_i2c_desc *rom_desc;
  707. struct edge_ti_manuf_descriptor *desc;
  708. rom_desc = kmalloc (sizeof (*rom_desc), GFP_KERNEL);
  709. if (!rom_desc) {
  710. dev_err (&serial->serial->dev->dev, "%s - out of memory\n", __FUNCTION__);
  711. return -ENOMEM;
  712. }
  713. start_address = TIGetDescriptorAddress (serial, I2C_DESC_TYPE_ION, rom_desc);
  714. if (!start_address) {
  715. dbg ("%s - Edge Descriptor not found in I2C", __FUNCTION__);
  716. status = -ENODEV;
  717. goto exit;
  718. }
  719. // Read the descriptor data
  720. status = TIReadRom (serial,
  721. start_address+sizeof(struct ti_i2c_desc),
  722. rom_desc->Size,
  723. buffer);
  724. if (status)
  725. goto exit;
  726. status = ValidChecksum(rom_desc, buffer);
  727. desc = (struct edge_ti_manuf_descriptor *)buffer;
  728. dbg ( "%s - IonConfig 0x%x", __FUNCTION__, desc->IonConfig );
  729. dbg ( "%s - Version %d", __FUNCTION__, desc->Version );
  730. dbg ( "%s - Cpu/Board 0x%x", __FUNCTION__, desc->CpuRev_BoardRev );
  731. dbg ( "%s - NumPorts %d", __FUNCTION__, desc->NumPorts );
  732. dbg ( "%s - NumVirtualPorts %d", __FUNCTION__, desc->NumVirtualPorts );
  733. dbg ( "%s - TotalPorts %d", __FUNCTION__, desc->TotalPorts );
  734. exit:
  735. kfree (rom_desc);
  736. return status;
  737. }
  738. /* Build firmware header used for firmware update */
  739. static int BuildI2CFirmwareHeader (__u8 *header, struct device *dev)
  740. {
  741. __u8 *buffer;
  742. int buffer_size;
  743. int i;
  744. __u8 cs = 0;
  745. struct ti_i2c_desc *i2c_header;
  746. struct ti_i2c_image_header *img_header;
  747. struct ti_i2c_firmware_rec *firmware_rec;
  748. // In order to update the I2C firmware we must change the type 2 record to type 0xF2.
  749. // This will force the UMP to come up in Boot Mode. Then while in boot mode, the driver
  750. // will download the latest firmware (padded to 15.5k) into the UMP ram.
  751. // And finally when the device comes back up in download mode the driver will cause
  752. // the new firmware to be copied from the UMP Ram to I2C and the firmware will update
  753. // the record type from 0xf2 to 0x02.
  754. // Allocate a 15.5k buffer + 2 bytes for version number (Firmware Record)
  755. buffer_size = (((1024 * 16) - 512 )+ sizeof(struct ti_i2c_firmware_rec));
  756. buffer = kmalloc (buffer_size, GFP_KERNEL);
  757. if (!buffer) {
  758. dev_err (dev, "%s - out of memory\n", __FUNCTION__);
  759. return -ENOMEM;
  760. }
  761. // Set entire image of 0xffs
  762. memset (buffer, 0xff, buffer_size);
  763. // Copy version number into firmware record
  764. firmware_rec = (struct ti_i2c_firmware_rec *)buffer;
  765. firmware_rec->Ver_Major = OperationalCodeImageVersion.MajorVersion;
  766. firmware_rec->Ver_Minor = OperationalCodeImageVersion.MinorVersion;
  767. // Pointer to fw_down memory image
  768. img_header = (struct ti_i2c_image_header *)&PagableOperationalCodeImage[0];
  769. memcpy (buffer + sizeof(struct ti_i2c_firmware_rec),
  770. &PagableOperationalCodeImage[sizeof(struct ti_i2c_image_header)],
  771. le16_to_cpu(img_header->Length));
  772. for (i=0; i < buffer_size; i++) {
  773. cs = (__u8)(cs + buffer[i]);
  774. }
  775. kfree (buffer);
  776. // Build new header
  777. i2c_header = (struct ti_i2c_desc *)header;
  778. firmware_rec = (struct ti_i2c_firmware_rec*)i2c_header->Data;
  779. i2c_header->Type = I2C_DESC_TYPE_FIRMWARE_BLANK;
  780. i2c_header->Size = (__u16)buffer_size;
  781. i2c_header->CheckSum = cs;
  782. firmware_rec->Ver_Major = OperationalCodeImageVersion.MajorVersion;
  783. firmware_rec->Ver_Minor = OperationalCodeImageVersion.MinorVersion;
  784. return 0;
  785. }
  786. /* Try to figure out what type of I2c we have */
  787. static int TIGetI2cTypeInBootMode (struct edgeport_serial *serial)
  788. {
  789. int status;
  790. __u8 data;
  791. // Try to read type 2
  792. status = TIReadVendorRequestSync (serial->serial->dev,
  793. UMPC_MEMORY_READ, // Request
  794. DTK_ADDR_SPACE_I2C_TYPE_II, // wValue (Address type)
  795. 0, // wIndex
  796. &data, // TransferBuffer
  797. 0x01); // TransferBufferLength
  798. if (status)
  799. dbg ("%s - read 2 status error = %d", __FUNCTION__, status);
  800. else
  801. dbg ("%s - read 2 data = 0x%x", __FUNCTION__, data);
  802. if ((!status) && (data == UMP5152 || data == UMP3410)) {
  803. dbg ("%s - ROM_TYPE_II", __FUNCTION__);
  804. serial->TI_I2C_Type = DTK_ADDR_SPACE_I2C_TYPE_II;
  805. return 0;
  806. }
  807. // Try to read type 3
  808. status = TIReadVendorRequestSync (serial->serial->dev,
  809. UMPC_MEMORY_READ, // Request
  810. DTK_ADDR_SPACE_I2C_TYPE_III, // wValue (Address type)
  811. 0, // wIndex
  812. &data, // TransferBuffer
  813. 0x01); // TransferBufferLength
  814. if (status)
  815. dbg ("%s - read 3 status error = %d", __FUNCTION__, status);
  816. else
  817. dbg ("%s - read 2 data = 0x%x", __FUNCTION__, data);
  818. if ((!status) && (data == UMP5152 || data == UMP3410)) {
  819. dbg ("%s - ROM_TYPE_III", __FUNCTION__);
  820. serial->TI_I2C_Type = DTK_ADDR_SPACE_I2C_TYPE_III;
  821. return 0;
  822. }
  823. dbg ("%s - Unknown", __FUNCTION__);
  824. serial->TI_I2C_Type = DTK_ADDR_SPACE_I2C_TYPE_II;
  825. return -ENODEV;
  826. }
  827. static int TISendBulkTransferSync (struct usb_serial *serial, void *buffer, int length, int *num_sent)
  828. {
  829. int status;
  830. status = usb_bulk_msg (serial->dev,
  831. usb_sndbulkpipe(serial->dev,
  832. serial->port[0]->bulk_out_endpointAddress),
  833. buffer,
  834. length,
  835. num_sent,
  836. 1000);
  837. return status;
  838. }
  839. /* Download given firmware image to the device (IN BOOT MODE) */
  840. static int TIDownloadCodeImage (struct edgeport_serial *serial, __u8 *image, int image_length)
  841. {
  842. int status = 0;
  843. int pos;
  844. int transfer;
  845. int done;
  846. // Transfer firmware image
  847. for (pos = 0; pos < image_length; ) {
  848. // Read the next buffer from file
  849. transfer = image_length - pos;
  850. if (transfer > EDGE_FW_BULK_MAX_PACKET_SIZE)
  851. transfer = EDGE_FW_BULK_MAX_PACKET_SIZE;
  852. // Transfer data
  853. status = TISendBulkTransferSync (serial->serial, &image[pos], transfer, &done);
  854. if (status)
  855. break;
  856. // Advance buffer pointer
  857. pos += done;
  858. }
  859. return status;
  860. }
  861. // FIXME!!!
  862. static int TIConfigureBootDevice (struct usb_device *dev)
  863. {
  864. return 0;
  865. }
  866. /**
  867. * DownloadTIFirmware - Download run-time operating firmware to the TI5052
  868. *
  869. * This routine downloads the main operating code into the TI5052, using the
  870. * boot code already burned into E2PROM or ROM.
  871. */
  872. static int TIDownloadFirmware (struct edgeport_serial *serial)
  873. {
  874. struct device *dev = &serial->serial->dev->dev;
  875. int status = 0;
  876. int start_address;
  877. struct edge_ti_manuf_descriptor *ti_manuf_desc;
  878. struct usb_interface_descriptor *interface;
  879. int download_cur_ver;
  880. int download_new_ver;
  881. /* This routine is entered by both the BOOT mode and the Download mode
  882. * We can determine which code is running by the reading the config
  883. * descriptor and if we have only one bulk pipe it is in boot mode
  884. */
  885. serial->product_info.hardware_type = HARDWARE_TYPE_TIUMP;
  886. /* Default to type 2 i2c */
  887. serial->TI_I2C_Type = DTK_ADDR_SPACE_I2C_TYPE_II;
  888. status = TIChooseConfiguration (serial->serial->dev);
  889. if (status)
  890. return status;
  891. interface = &serial->serial->interface->cur_altsetting->desc;
  892. if (!interface) {
  893. dev_err (dev, "%s - no interface set, error!\n", __FUNCTION__);
  894. return -ENODEV;
  895. }
  896. // Setup initial mode -- the default mode 0 is TI_MODE_CONFIGURING
  897. // if we have more than one endpoint we are definitely in download mode
  898. if (interface->bNumEndpoints > 1)
  899. serial->product_info.TiMode = TI_MODE_DOWNLOAD;
  900. else
  901. // Otherwise we will remain in configuring mode
  902. serial->product_info.TiMode = TI_MODE_CONFIGURING;
  903. // Save Download Version Number
  904. OperationalCodeImageVersion.MajorVersion = PagableOperationalCodeImageVersion.MajorVersion;
  905. OperationalCodeImageVersion.MinorVersion = PagableOperationalCodeImageVersion.MinorVersion;
  906. OperationalCodeImageVersion.BuildNumber = PagableOperationalCodeImageVersion.BuildNumber;
  907. /********************************************************************/
  908. /* Download Mode */
  909. /********************************************************************/
  910. if (serial->product_info.TiMode == TI_MODE_DOWNLOAD) {
  911. struct ti_i2c_desc *rom_desc;
  912. dbg ("%s - <<<<<<<<<<<<<<<RUNNING IN DOWNLOAD MODE>>>>>>>>>>", __FUNCTION__);
  913. status = TiValidateI2cImage (serial);
  914. if (status) {
  915. dbg ("%s - <<<<<<<<<<<<<<<DOWNLOAD MODE -- BAD I2C >>>>>>>>>>",
  916. __FUNCTION__);
  917. return status;
  918. }
  919. /* Validate Hardware version number
  920. * Read Manufacturing Descriptor from TI Based Edgeport
  921. */
  922. ti_manuf_desc = kmalloc (sizeof (*ti_manuf_desc), GFP_KERNEL);
  923. if (!ti_manuf_desc) {
  924. dev_err (dev, "%s - out of memory.\n", __FUNCTION__);
  925. return -ENOMEM;
  926. }
  927. status = TIReadManufDescriptor (serial, (__u8 *)ti_manuf_desc);
  928. if (status) {
  929. kfree (ti_manuf_desc);
  930. return status;
  931. }
  932. // Check version number of ION descriptor
  933. if (!ignore_cpu_rev && TI_GET_CPU_REVISION(ti_manuf_desc->CpuRev_BoardRev) < 2) {
  934. dbg ( "%s - Wrong CPU Rev %d (Must be 2)", __FUNCTION__,
  935. TI_GET_CPU_REVISION(ti_manuf_desc->CpuRev_BoardRev));
  936. kfree (ti_manuf_desc);
  937. return -EINVAL;
  938. }
  939. rom_desc = kmalloc (sizeof (*rom_desc), GFP_KERNEL);
  940. if (!rom_desc) {
  941. dev_err (dev, "%s - out of memory.\n", __FUNCTION__);
  942. kfree (ti_manuf_desc);
  943. return -ENOMEM;
  944. }
  945. // Search for type 2 record (firmware record)
  946. if ((start_address = TIGetDescriptorAddress (serial, I2C_DESC_TYPE_FIRMWARE_BASIC, rom_desc)) != 0) {
  947. struct ti_i2c_firmware_rec *firmware_version;
  948. __u8 record;
  949. dbg ("%s - Found Type FIRMWARE (Type 2) record", __FUNCTION__);
  950. firmware_version = kmalloc (sizeof (*firmware_version), GFP_KERNEL);
  951. if (!firmware_version) {
  952. dev_err (dev, "%s - out of memory.\n", __FUNCTION__);
  953. kfree (rom_desc);
  954. kfree (ti_manuf_desc);
  955. return -ENOMEM;
  956. }
  957. // Validate version number
  958. // Read the descriptor data
  959. status = TIReadRom (serial,
  960. start_address+sizeof(struct ti_i2c_desc),
  961. sizeof(struct ti_i2c_firmware_rec),
  962. (__u8 *)firmware_version);
  963. if (status) {
  964. kfree (firmware_version);
  965. kfree (rom_desc);
  966. kfree (ti_manuf_desc);
  967. return status;
  968. }
  969. // Check version number of download with current version in I2c
  970. download_cur_ver = (firmware_version->Ver_Major << 8) +
  971. (firmware_version->Ver_Minor);
  972. download_new_ver = (OperationalCodeImageVersion.MajorVersion << 8) +
  973. (OperationalCodeImageVersion.MinorVersion);
  974. dbg ("%s - >>>Firmware Versions Device %d.%d Driver %d.%d",
  975. __FUNCTION__,
  976. firmware_version->Ver_Major,
  977. firmware_version->Ver_Minor,
  978. OperationalCodeImageVersion.MajorVersion,
  979. OperationalCodeImageVersion.MinorVersion);
  980. // Check if we have an old version in the I2C and update if necessary
  981. if (download_cur_ver != download_new_ver) {
  982. dbg ("%s - Update I2C Download from %d.%d to %d.%d",
  983. __FUNCTION__,
  984. firmware_version->Ver_Major,
  985. firmware_version->Ver_Minor,
  986. OperationalCodeImageVersion.MajorVersion,
  987. OperationalCodeImageVersion.MinorVersion);
  988. // In order to update the I2C firmware we must change the type 2 record to type 0xF2.
  989. // This will force the UMP to come up in Boot Mode. Then while in boot mode, the driver
  990. // will download the latest firmware (padded to 15.5k) into the UMP ram.
  991. // And finally when the device comes back up in download mode the driver will cause
  992. // the new firmware to be copied from the UMP Ram to I2C and the firmware will update
  993. // the record type from 0xf2 to 0x02.
  994. record = I2C_DESC_TYPE_FIRMWARE_BLANK;
  995. // Change the I2C Firmware record type to 0xf2 to trigger an update
  996. status = TIWriteRom (serial,
  997. start_address,
  998. sizeof(record),
  999. &record);
  1000. if (status) {
  1001. kfree (firmware_version);
  1002. kfree (rom_desc);
  1003. kfree (ti_manuf_desc);
  1004. return status;
  1005. }
  1006. // verify the write -- must do this in order for write to
  1007. // complete before we do the hardware reset
  1008. status = TIReadRom (serial,
  1009. start_address,
  1010. sizeof(record),
  1011. &record);
  1012. if (status) {
  1013. kfree (firmware_version);
  1014. kfree (rom_desc);
  1015. kfree (ti_manuf_desc);
  1016. return status;
  1017. }
  1018. if (record != I2C_DESC_TYPE_FIRMWARE_BLANK) {
  1019. dev_err (dev, "%s - error resetting device\n", __FUNCTION__);
  1020. kfree (firmware_version);
  1021. kfree (rom_desc);
  1022. kfree (ti_manuf_desc);
  1023. return -ENODEV;
  1024. }
  1025. dbg ("%s - HARDWARE RESET", __FUNCTION__);
  1026. // Reset UMP -- Back to BOOT MODE
  1027. status = TISendVendorRequestSync (serial->serial->dev,
  1028. UMPC_HARDWARE_RESET, // Request
  1029. 0, // wValue
  1030. 0, // wIndex
  1031. NULL, // TransferBuffer
  1032. 0); // TransferBufferLength
  1033. dbg ( "%s - HARDWARE RESET return %d", __FUNCTION__, status);
  1034. /* return an error on purpose. */
  1035. kfree (firmware_version);
  1036. kfree (rom_desc);
  1037. kfree (ti_manuf_desc);
  1038. return -ENODEV;
  1039. }
  1040. kfree (firmware_version);
  1041. }
  1042. // Search for type 0xF2 record (firmware blank record)
  1043. else if ((start_address = TIGetDescriptorAddress (serial, I2C_DESC_TYPE_FIRMWARE_BLANK, rom_desc)) != 0) {
  1044. #define HEADER_SIZE (sizeof(struct ti_i2c_desc) + sizeof(struct ti_i2c_firmware_rec))
  1045. __u8 *header;
  1046. __u8 *vheader;
  1047. header = kmalloc (HEADER_SIZE, GFP_KERNEL);
  1048. if (!header) {
  1049. dev_err (dev, "%s - out of memory.\n", __FUNCTION__);
  1050. kfree (rom_desc);
  1051. kfree (ti_manuf_desc);
  1052. return -ENOMEM;
  1053. }
  1054. vheader = kmalloc (HEADER_SIZE, GFP_KERNEL);
  1055. if (!vheader) {
  1056. dev_err (dev, "%s - out of memory.\n", __FUNCTION__);
  1057. kfree (header);
  1058. kfree (rom_desc);
  1059. kfree (ti_manuf_desc);
  1060. return -ENOMEM;
  1061. }
  1062. dbg ("%s - Found Type BLANK FIRMWARE (Type F2) record", __FUNCTION__);
  1063. // In order to update the I2C firmware we must change the type 2 record to type 0xF2.
  1064. // This will force the UMP to come up in Boot Mode. Then while in boot mode, the driver
  1065. // will download the latest firmware (padded to 15.5k) into the UMP ram.
  1066. // And finally when the device comes back up in download mode the driver will cause
  1067. // the new firmware to be copied from the UMP Ram to I2C and the firmware will update
  1068. // the record type from 0xf2 to 0x02.
  1069. status = BuildI2CFirmwareHeader(header, dev);
  1070. if (status) {
  1071. kfree (vheader);
  1072. kfree (header);
  1073. kfree (rom_desc);
  1074. kfree (ti_manuf_desc);
  1075. return status;
  1076. }
  1077. // Update I2C with type 0xf2 record with correct size and checksum
  1078. status = TIWriteRom (serial,
  1079. start_address,
  1080. HEADER_SIZE,
  1081. header);
  1082. if (status) {
  1083. kfree (vheader);
  1084. kfree (header);
  1085. kfree (rom_desc);
  1086. kfree (ti_manuf_desc);
  1087. return status;
  1088. }
  1089. // verify the write -- must do this in order for write to
  1090. // complete before we do the hardware reset
  1091. status = TIReadRom (serial,
  1092. start_address,
  1093. HEADER_SIZE,
  1094. vheader);
  1095. if (status) {
  1096. dbg ("%s - can't read header back", __FUNCTION__);
  1097. kfree (vheader);
  1098. kfree (header);
  1099. kfree (rom_desc);
  1100. kfree (ti_manuf_desc);
  1101. return status;
  1102. }
  1103. if (memcmp(vheader, header, HEADER_SIZE)) {
  1104. dbg ("%s - write download record failed", __FUNCTION__);
  1105. kfree (vheader);
  1106. kfree (header);
  1107. kfree (rom_desc);
  1108. kfree (ti_manuf_desc);
  1109. return status;
  1110. }
  1111. kfree (vheader);
  1112. kfree (header);
  1113. dbg ("%s - Start firmware update", __FUNCTION__);
  1114. // Tell firmware to copy download image into I2C
  1115. status = TISendVendorRequestSync (serial->serial->dev,
  1116. UMPC_COPY_DNLD_TO_I2C, // Request
  1117. 0, // wValue
  1118. 0, // wIndex
  1119. NULL, // TransferBuffer
  1120. 0); // TransferBufferLength
  1121. dbg ("%s - Update complete 0x%x", __FUNCTION__, status);
  1122. if (status) {
  1123. dev_err (dev, "%s - UMPC_COPY_DNLD_TO_I2C failed\n", __FUNCTION__);
  1124. kfree (rom_desc);
  1125. kfree (ti_manuf_desc);
  1126. return status;
  1127. }
  1128. }
  1129. // The device is running the download code
  1130. kfree (rom_desc);
  1131. kfree (ti_manuf_desc);
  1132. return 0;
  1133. }
  1134. /********************************************************************/
  1135. /* Boot Mode */
  1136. /********************************************************************/
  1137. dbg ("%s - <<<<<<<<<<<<<<<RUNNING IN BOOT MODE>>>>>>>>>>>>>>>",
  1138. __FUNCTION__);
  1139. // Configure the TI device so we can use the BULK pipes for download
  1140. status = TIConfigureBootDevice (serial->serial->dev);
  1141. if (status)
  1142. return status;
  1143. if (le16_to_cpu(serial->serial->dev->descriptor.idVendor) != USB_VENDOR_ID_ION) {
  1144. dbg ("%s - VID = 0x%x", __FUNCTION__,
  1145. le16_to_cpu(serial->serial->dev->descriptor.idVendor));
  1146. serial->TI_I2C_Type = DTK_ADDR_SPACE_I2C_TYPE_II;
  1147. goto StayInBootMode;
  1148. }
  1149. // We have an ION device (I2c Must be programmed)
  1150. // Determine I2C image type
  1151. if (TIGetI2cTypeInBootMode(serial)) {
  1152. goto StayInBootMode;
  1153. }
  1154. // Registry variable set?
  1155. if (TIStayInBootMode) {
  1156. dbg ("%s - TIStayInBootMode", __FUNCTION__);
  1157. goto StayInBootMode;
  1158. }
  1159. // Check for ION Vendor ID and that the I2C is valid
  1160. if (!TiValidateI2cImage(serial)) {
  1161. struct ti_i2c_image_header *header;
  1162. int i;
  1163. __u8 cs = 0;
  1164. __u8 *buffer;
  1165. int buffer_size;
  1166. /* Validate Hardware version number
  1167. * Read Manufacturing Descriptor from TI Based Edgeport
  1168. */
  1169. ti_manuf_desc = kmalloc (sizeof (*ti_manuf_desc), GFP_KERNEL);
  1170. if (!ti_manuf_desc) {
  1171. dev_err (dev, "%s - out of memory.\n", __FUNCTION__);
  1172. return -ENOMEM;
  1173. }
  1174. status = TIReadManufDescriptor (serial, (__u8 *)ti_manuf_desc);
  1175. if (status) {
  1176. kfree (ti_manuf_desc);
  1177. goto StayInBootMode;
  1178. }
  1179. // Check for version 2
  1180. if (!ignore_cpu_rev && TI_GET_CPU_REVISION(ti_manuf_desc->CpuRev_BoardRev) < 2) {
  1181. dbg ("%s - Wrong CPU Rev %d (Must be 2)", __FUNCTION__,
  1182. TI_GET_CPU_REVISION(ti_manuf_desc->CpuRev_BoardRev));
  1183. kfree (ti_manuf_desc);
  1184. goto StayInBootMode;
  1185. }
  1186. kfree (ti_manuf_desc);
  1187. // In order to update the I2C firmware we must change the type 2 record to type 0xF2.
  1188. // This will force the UMP to come up in Boot Mode. Then while in boot mode, the driver
  1189. // will download the latest firmware (padded to 15.5k) into the UMP ram.
  1190. // And finally when the device comes back up in download mode the driver will cause
  1191. // the new firmware to be copied from the UMP Ram to I2C and the firmware will update
  1192. // the record type from 0xf2 to 0x02.
  1193. /*
  1194. * Do we really have to copy the whole firmware image,
  1195. * or could we do this in place!
  1196. */
  1197. // Allocate a 15.5k buffer + 3 byte header
  1198. buffer_size = (((1024 * 16) - 512) + sizeof(struct ti_i2c_image_header));
  1199. buffer = kmalloc (buffer_size, GFP_KERNEL);
  1200. if (!buffer) {
  1201. dev_err (dev, "%s - out of memory\n", __FUNCTION__);
  1202. return -ENOMEM;
  1203. }
  1204. // Initialize the buffer to 0xff (pad the buffer)
  1205. memset (buffer, 0xff, buffer_size);
  1206. memcpy (buffer, &PagableOperationalCodeImage[0], PagableOperationalCodeSize);
  1207. for(i = sizeof(struct ti_i2c_image_header); i < buffer_size; i++) {
  1208. cs = (__u8)(cs + buffer[i]);
  1209. }
  1210. header = (struct ti_i2c_image_header *)buffer;
  1211. // update length and checksum after padding
  1212. header->Length = cpu_to_le16((__u16)(buffer_size - sizeof(struct ti_i2c_image_header)));
  1213. header->CheckSum = cs;
  1214. // Download the operational code
  1215. dbg ("%s - Downloading operational code image (TI UMP)", __FUNCTION__);
  1216. status = TIDownloadCodeImage (serial, buffer, buffer_size);
  1217. kfree (buffer);
  1218. if (status) {
  1219. dbg ("%s - Error downloading operational code image", __FUNCTION__);
  1220. return status;
  1221. }
  1222. // Device will reboot
  1223. serial->product_info.TiMode = TI_MODE_TRANSITIONING;
  1224. dbg ("%s - Download successful -- Device rebooting...", __FUNCTION__);
  1225. /* return an error on purpose */
  1226. return -ENODEV;
  1227. }
  1228. StayInBootMode:
  1229. // Eprom is invalid or blank stay in boot mode
  1230. dbg ("%s - <<<<<<<<<<<<<<<STAYING IN BOOT MODE>>>>>>>>>>>>", __FUNCTION__);
  1231. serial->product_info.TiMode = TI_MODE_BOOT;
  1232. return 0;
  1233. }
  1234. static int TISetDtr (struct edgeport_port *port)
  1235. {
  1236. int port_number = port->port->number - port->port->serial->minor;
  1237. dbg ("%s", __FUNCTION__);
  1238. port->shadow_mcr |= MCR_DTR;
  1239. return TIWriteCommandSync (port->port->serial->dev,
  1240. UMPC_SET_CLR_DTR,
  1241. (__u8)(UMPM_UART1_PORT + port_number),
  1242. 1, /* set */
  1243. NULL,
  1244. 0);
  1245. }
  1246. static int TIClearDtr (struct edgeport_port *port)
  1247. {
  1248. int port_number = port->port->number - port->port->serial->minor;
  1249. dbg ("%s", __FUNCTION__);
  1250. port->shadow_mcr &= ~MCR_DTR;
  1251. return TIWriteCommandSync (port->port->serial->dev,
  1252. UMPC_SET_CLR_DTR,
  1253. (__u8)(UMPM_UART1_PORT + port_number),
  1254. 0, /* clear */
  1255. NULL,
  1256. 0);
  1257. }
  1258. static int TISetRts (struct edgeport_port *port)
  1259. {
  1260. int port_number = port->port->number - port->port->serial->minor;
  1261. dbg ("%s", __FUNCTION__);
  1262. port->shadow_mcr |= MCR_RTS;
  1263. return TIWriteCommandSync (port->port->serial->dev,
  1264. UMPC_SET_CLR_RTS,
  1265. (__u8)(UMPM_UART1_PORT + port_number),
  1266. 1, /* set */
  1267. NULL,
  1268. 0);
  1269. }
  1270. static int TIClearRts (struct edgeport_port *port)
  1271. {
  1272. int port_number = port->port->number - port->port->serial->minor;
  1273. dbg ("%s", __FUNCTION__);
  1274. port->shadow_mcr &= ~MCR_RTS;
  1275. return TIWriteCommandSync (port->port->serial->dev,
  1276. UMPC_SET_CLR_RTS,
  1277. (__u8)(UMPM_UART1_PORT + port_number),
  1278. 0, /* clear */
  1279. NULL,
  1280. 0);
  1281. }
  1282. static int TISetLoopBack (struct edgeport_port *port)
  1283. {
  1284. int port_number = port->port->number - port->port->serial->minor;
  1285. dbg ("%s", __FUNCTION__);
  1286. return TIWriteCommandSync (port->port->serial->dev,
  1287. UMPC_SET_CLR_LOOPBACK,
  1288. (__u8)(UMPM_UART1_PORT + port_number),
  1289. 1, /* set */
  1290. NULL,
  1291. 0);
  1292. }
  1293. static int TIClearLoopBack (struct edgeport_port *port)
  1294. {
  1295. int port_number = port->port->number - port->port->serial->minor;
  1296. dbg ("%s", __FUNCTION__);
  1297. return TIWriteCommandSync (port->port->serial->dev,
  1298. UMPC_SET_CLR_LOOPBACK,
  1299. (__u8)(UMPM_UART1_PORT + port_number),
  1300. 0, /* clear */
  1301. NULL,
  1302. 0);
  1303. }
  1304. static int TISetBreak (struct edgeport_port *port)
  1305. {
  1306. int port_number = port->port->number - port->port->serial->minor;
  1307. dbg ("%s", __FUNCTION__);
  1308. return TIWriteCommandSync (port->port->serial->dev,
  1309. UMPC_SET_CLR_BREAK,
  1310. (__u8)(UMPM_UART1_PORT + port_number),
  1311. 1, /* set */
  1312. NULL,
  1313. 0);
  1314. }
  1315. static int TIClearBreak (struct edgeport_port *port)
  1316. {
  1317. int port_number = port->port->number - port->port->serial->minor;
  1318. dbg ("%s", __FUNCTION__);
  1319. return TIWriteCommandSync (port->port->serial->dev,
  1320. UMPC_SET_CLR_BREAK,
  1321. (__u8)(UMPM_UART1_PORT + port_number),
  1322. 0, /* clear */
  1323. NULL,
  1324. 0);
  1325. }
  1326. static int TIRestoreMCR (struct edgeport_port *port, __u8 mcr)
  1327. {
  1328. int status = 0;
  1329. dbg ("%s - %x", __FUNCTION__, mcr);
  1330. if (mcr & MCR_DTR)
  1331. status = TISetDtr (port);
  1332. else
  1333. status = TIClearDtr (port);
  1334. if (status)
  1335. return status;
  1336. if (mcr & MCR_RTS)
  1337. status = TISetRts (port);
  1338. else
  1339. status = TIClearRts (port);
  1340. if (status)
  1341. return status;
  1342. if (mcr & MCR_LOOPBACK)
  1343. status = TISetLoopBack (port);
  1344. else
  1345. status = TIClearLoopBack (port);
  1346. return status;
  1347. }
  1348. /* Convert TI LSR to standard UART flags */
  1349. static __u8 MapLineStatus (__u8 ti_lsr)
  1350. {
  1351. __u8 lsr = 0;
  1352. #define MAP_FLAG(flagUmp, flagUart) \
  1353. if (ti_lsr & flagUmp) \
  1354. lsr |= flagUart;
  1355. MAP_FLAG(UMP_UART_LSR_OV_MASK, LSR_OVER_ERR) /* overrun */
  1356. MAP_FLAG(UMP_UART_LSR_PE_MASK, LSR_PAR_ERR) /* parity error */
  1357. MAP_FLAG(UMP_UART_LSR_FE_MASK, LSR_FRM_ERR) /* framing error */
  1358. MAP_FLAG(UMP_UART_LSR_BR_MASK, LSR_BREAK) /* break detected */
  1359. MAP_FLAG(UMP_UART_LSR_RX_MASK, LSR_RX_AVAIL) /* receive data available */
  1360. MAP_FLAG(UMP_UART_LSR_TX_MASK, LSR_TX_EMPTY) /* transmit holding register empty */
  1361. #undef MAP_FLAG
  1362. return lsr;
  1363. }
  1364. static void handle_new_msr (struct edgeport_port *edge_port, __u8 msr)
  1365. {
  1366. struct async_icount *icount;
  1367. struct tty_struct *tty;
  1368. dbg ("%s - %02x", __FUNCTION__, msr);
  1369. if (msr & (EDGEPORT_MSR_DELTA_CTS | EDGEPORT_MSR_DELTA_DSR | EDGEPORT_MSR_DELTA_RI | EDGEPORT_MSR_DELTA_CD)) {
  1370. icount = &edge_port->icount;
  1371. /* update input line counters */
  1372. if (msr & EDGEPORT_MSR_DELTA_CTS)
  1373. icount->cts++;
  1374. if (msr & EDGEPORT_MSR_DELTA_DSR)
  1375. icount->dsr++;
  1376. if (msr & EDGEPORT_MSR_DELTA_CD)
  1377. icount->dcd++;
  1378. if (msr & EDGEPORT_MSR_DELTA_RI)
  1379. icount->rng++;
  1380. wake_up_interruptible (&edge_port->delta_msr_wait);
  1381. }
  1382. /* Save the new modem status */
  1383. edge_port->shadow_msr = msr & 0xf0;
  1384. tty = edge_port->port->tty;
  1385. /* handle CTS flow control */
  1386. if (tty && C_CRTSCTS(tty)) {
  1387. if (msr & EDGEPORT_MSR_CTS) {
  1388. tty->hw_stopped = 0;
  1389. tty_wakeup(tty);
  1390. } else {
  1391. tty->hw_stopped = 1;
  1392. }
  1393. }
  1394. return;
  1395. }
  1396. static void handle_new_lsr (struct edgeport_port *edge_port, int lsr_data, __u8 lsr, __u8 data)
  1397. {
  1398. struct async_icount *icount;
  1399. __u8 new_lsr = (__u8)(lsr & (__u8)(LSR_OVER_ERR | LSR_PAR_ERR | LSR_FRM_ERR | LSR_BREAK));
  1400. dbg ("%s - %02x", __FUNCTION__, new_lsr);
  1401. edge_port->shadow_lsr = lsr;
  1402. if (new_lsr & LSR_BREAK) {
  1403. /*
  1404. * Parity and Framing errors only count if they
  1405. * occur exclusive of a break being received.
  1406. */
  1407. new_lsr &= (__u8)(LSR_OVER_ERR | LSR_BREAK);
  1408. }
  1409. /* Place LSR data byte into Rx buffer */
  1410. if (lsr_data && edge_port->port->tty)
  1411. edge_tty_recv(&edge_port->port->dev, edge_port->port->tty, &data, 1);
  1412. /* update input line counters */
  1413. icount = &edge_port->icount;
  1414. if (new_lsr & LSR_BREAK)
  1415. icount->brk++;
  1416. if (new_lsr & LSR_OVER_ERR)
  1417. icount->overrun++;
  1418. if (new_lsr & LSR_PAR_ERR)
  1419. icount->parity++;
  1420. if (new_lsr & LSR_FRM_ERR)
  1421. icount->frame++;
  1422. }
  1423. static void edge_interrupt_callback (struct urb *urb, struct pt_regs *regs)
  1424. {
  1425. struct edgeport_serial *edge_serial = (struct edgeport_serial *)urb->context;
  1426. struct usb_serial_port *port;
  1427. struct edgeport_port *edge_port;
  1428. unsigned char *data = urb->transfer_buffer;
  1429. int length = urb->actual_length;
  1430. int port_number;
  1431. int function;
  1432. int status;
  1433. __u8 lsr;
  1434. __u8 msr;
  1435. dbg("%s", __FUNCTION__);
  1436. switch (urb->status) {
  1437. case 0:
  1438. /* success */
  1439. break;
  1440. case -ECONNRESET:
  1441. case -ENOENT:
  1442. case -ESHUTDOWN:
  1443. /* this urb is terminated, clean up */
  1444. dbg("%s - urb shutting down with status: %d", __FUNCTION__, urb->status);
  1445. return;
  1446. default:
  1447. dev_err(&urb->dev->dev, "%s - nonzero urb status received: %d\n", __FUNCTION__, urb->status);
  1448. goto exit;
  1449. }
  1450. if (!length) {
  1451. dbg ("%s - no data in urb", __FUNCTION__);
  1452. goto exit;
  1453. }
  1454. usb_serial_debug_data(debug, &edge_serial->serial->dev->dev, __FUNCTION__, length, data);
  1455. if (length != 2) {
  1456. dbg ("%s - expecting packet of size 2, got %d", __FUNCTION__, length);
  1457. goto exit;
  1458. }
  1459. port_number = TIUMP_GET_PORT_FROM_CODE (data[0]);
  1460. function = TIUMP_GET_FUNC_FROM_CODE (data[0]);
  1461. dbg ("%s - port_number %d, function %d, info 0x%x",
  1462. __FUNCTION__, port_number, function, data[1]);
  1463. port = edge_serial->serial->port[port_number];
  1464. edge_port = usb_get_serial_port_data(port);
  1465. if (!edge_port) {
  1466. dbg ("%s - edge_port not found", __FUNCTION__);
  1467. return;
  1468. }
  1469. switch (function) {
  1470. case TIUMP_INTERRUPT_CODE_LSR:
  1471. lsr = MapLineStatus(data[1]);
  1472. if (lsr & UMP_UART_LSR_DATA_MASK) {
  1473. /* Save the LSR event for bulk read completion routine */
  1474. dbg ("%s - LSR Event Port %u LSR Status = %02x",
  1475. __FUNCTION__, port_number, lsr);
  1476. edge_port->lsr_event = 1;
  1477. edge_port->lsr_mask = lsr;
  1478. } else {
  1479. dbg ("%s - ===== Port %d LSR Status = %02x ======",
  1480. __FUNCTION__, port_number, lsr);
  1481. handle_new_lsr (edge_port, 0, lsr, 0);
  1482. }
  1483. break;
  1484. case TIUMP_INTERRUPT_CODE_MSR: // MSR
  1485. /* Copy MSR from UMP */
  1486. msr = data[1];
  1487. dbg ("%s - ===== Port %u MSR Status = %02x ======\n",
  1488. __FUNCTION__, port_number, msr);
  1489. handle_new_msr (edge_port, msr);
  1490. break;
  1491. default:
  1492. dev_err (&urb->dev->dev, "%s - Unknown Interrupt code from UMP %x\n",
  1493. __FUNCTION__, data[1]);
  1494. break;
  1495. }
  1496. exit:
  1497. status = usb_submit_urb (urb, GFP_ATOMIC);
  1498. if (status)
  1499. dev_err (&urb->dev->dev, "%s - usb_submit_urb failed with result %d\n",
  1500. __FUNCTION__, status);
  1501. }
  1502. static void edge_bulk_in_callback (struct urb *urb, struct pt_regs *regs)
  1503. {
  1504. struct edgeport_port *edge_port = (struct edgeport_port *)urb->context;
  1505. unsigned char *data = urb->transfer_buffer;
  1506. struct tty_struct *tty;
  1507. int status = 0;
  1508. int port_number;
  1509. dbg("%s", __FUNCTION__);
  1510. switch (urb->status) {
  1511. case 0:
  1512. /* success */
  1513. break;
  1514. case -ECONNRESET:
  1515. case -ENOENT:
  1516. case -ESHUTDOWN:
  1517. /* this urb is terminated, clean up */
  1518. dbg("%s - urb shutting down with status: %d", __FUNCTION__, urb->status);
  1519. return;
  1520. default:
  1521. dev_err (&urb->dev->dev,"%s - nonzero read bulk status received: %d\n",
  1522. __FUNCTION__, urb->status );
  1523. }
  1524. if (urb->status == -EPIPE)
  1525. goto exit;
  1526. if (urb->status) {
  1527. dev_err(&urb->dev->dev,"%s - stopping read!\n", __FUNCTION__);
  1528. return;
  1529. }
  1530. port_number = edge_port->port->number - edge_port->port->serial->minor;
  1531. if (edge_port->lsr_event) {
  1532. edge_port->lsr_event = 0;
  1533. dbg ("%s ===== Port %u LSR Status = %02x, Data = %02x ======",
  1534. __FUNCTION__, port_number, edge_port->lsr_mask, *data);
  1535. handle_new_lsr (edge_port, 1, edge_port->lsr_mask, *data);
  1536. /* Adjust buffer length/pointer */
  1537. --urb->actual_length;
  1538. ++data;
  1539. }
  1540. tty = edge_port->port->tty;
  1541. if (tty && urb->actual_length) {
  1542. usb_serial_debug_data(debug, &edge_port->port->dev, __FUNCTION__, urb->actual_length, data);
  1543. if (edge_port->close_pending) {
  1544. dbg ("%s - close is pending, dropping data on the floor.", __FUNCTION__);
  1545. } else {
  1546. edge_tty_recv(&edge_port->port->dev, tty, data, urb->actual_length);
  1547. }
  1548. edge_port->icount.rx += urb->actual_length;
  1549. }
  1550. exit:
  1551. /* continue read unless stopped */
  1552. spin_lock(&edge_port->ep_lock);
  1553. if (edge_port->ep_read_urb_state == EDGE_READ_URB_RUNNING) {
  1554. urb->dev = edge_port->port->serial->dev;
  1555. status = usb_submit_urb(urb, GFP_ATOMIC);
  1556. } else if (edge_port->ep_read_urb_state == EDGE_READ_URB_STOPPING) {
  1557. edge_port->ep_read_urb_state = EDGE_READ_URB_STOPPED;
  1558. }
  1559. spin_unlock(&edge_port->ep_lock);
  1560. if (status)
  1561. dev_err (&urb->dev->dev, "%s - usb_submit_urb failed with result %d\n",
  1562. __FUNCTION__, status);
  1563. }
  1564. static void edge_tty_recv(struct device *dev, struct tty_struct *tty, unsigned char *data, int length)
  1565. {
  1566. int cnt;
  1567. do {
  1568. cnt = tty_buffer_request_room(tty, length);
  1569. if (cnt < length) {
  1570. dev_err(dev, "%s - dropping data, %d bytes lost\n",
  1571. __FUNCTION__, length - cnt);
  1572. if(cnt == 0)
  1573. break;
  1574. }
  1575. tty_insert_flip_string(tty, data, cnt);
  1576. data += cnt;
  1577. length -= cnt;
  1578. } while (length > 0);
  1579. tty_flip_buffer_push(tty);
  1580. }
  1581. static void edge_bulk_out_callback (struct urb *urb, struct pt_regs *regs)
  1582. {
  1583. struct usb_serial_port *port = (struct usb_serial_port *)urb->context;
  1584. struct edgeport_port *edge_port = usb_get_serial_port_data(port);
  1585. dbg ("%s - port %d", __FUNCTION__, port->number);
  1586. edge_port->ep_write_urb_in_use = 0;
  1587. switch (urb->status) {
  1588. case 0:
  1589. /* success */
  1590. break;
  1591. case -ECONNRESET:
  1592. case -ENOENT:
  1593. case -ESHUTDOWN:
  1594. /* this urb is terminated, clean up */
  1595. dbg("%s - urb shutting down with status: %d", __FUNCTION__, urb->status);
  1596. return;
  1597. default:
  1598. dev_err (&urb->dev->dev,"%s - nonzero write bulk status received: %d\n",
  1599. __FUNCTION__, urb->status);
  1600. }
  1601. /* send any buffered data */
  1602. edge_send(port);
  1603. }
  1604. static int edge_open (struct usb_serial_port *port, struct file * filp)
  1605. {
  1606. struct edgeport_port *edge_port = usb_get_serial_port_data(port);
  1607. struct edgeport_serial *edge_serial;
  1608. struct usb_device *dev;
  1609. struct urb *urb;
  1610. int port_number;
  1611. int status;
  1612. u16 open_settings;
  1613. u8 transaction_timeout;
  1614. dbg("%s - port %d", __FUNCTION__, port->number);
  1615. if (edge_port == NULL)
  1616. return -ENODEV;
  1617. if (port->tty)
  1618. port->tty->low_latency = low_latency;
  1619. port_number = port->number - port->serial->minor;
  1620. switch (port_number) {
  1621. case 0:
  1622. edge_port->uart_base = UMPMEM_BASE_UART1;
  1623. edge_port->dma_address = UMPD_OEDB1_ADDRESS;
  1624. break;
  1625. case 1:
  1626. edge_port->uart_base = UMPMEM_BASE_UART2;
  1627. edge_port->dma_address = UMPD_OEDB2_ADDRESS;
  1628. break;
  1629. default:
  1630. dev_err (&port->dev, "Unknown port number!!!\n");
  1631. return -ENODEV;
  1632. }
  1633. dbg ("%s - port_number = %d, uart_base = %04x, dma_address = %04x",
  1634. __FUNCTION__, port_number, edge_port->uart_base, edge_port->dma_address);
  1635. dev = port->serial->dev;
  1636. memset (&(edge_port->icount), 0x00, sizeof(edge_port->icount));
  1637. init_waitqueue_head (&edge_port->delta_msr_wait);
  1638. /* turn off loopback */
  1639. status = TIClearLoopBack (edge_port);
  1640. if (status) {
  1641. dev_err(&port->dev,"%s - cannot send clear loopback command, %d\n",
  1642. __FUNCTION__, status);
  1643. return status;
  1644. }
  1645. /* set up the port settings */
  1646. edge_set_termios (port, NULL);
  1647. /* open up the port */
  1648. /* milliseconds to timeout for DMA transfer */
  1649. transaction_timeout = 2;
  1650. edge_port->ump_read_timeout = max (20, ((transaction_timeout * 3) / 2) );
  1651. // milliseconds to timeout for DMA transfer
  1652. open_settings = (u8)(UMP_DMA_MODE_CONTINOUS |
  1653. UMP_PIPE_TRANS_TIMEOUT_ENA |
  1654. (transaction_timeout << 2));
  1655. dbg ("%s - Sending UMPC_OPEN_PORT", __FUNCTION__);
  1656. /* Tell TI to open and start the port */
  1657. status = TIWriteCommandSync (dev,
  1658. UMPC_OPEN_PORT,
  1659. (u8)(UMPM_UART1_PORT + port_number),
  1660. open_settings,
  1661. NULL,
  1662. 0);
  1663. if (status) {
  1664. dev_err(&port->dev,"%s - cannot send open command, %d\n", __FUNCTION__, status);
  1665. return status;
  1666. }
  1667. /* Start the DMA? */
  1668. status = TIWriteCommandSync (dev,
  1669. UMPC_START_PORT,
  1670. (u8)(UMPM_UART1_PORT + port_number),
  1671. 0,
  1672. NULL,
  1673. 0);
  1674. if (status) {
  1675. dev_err(&port->dev,"%s - cannot send start DMA command, %d\n", __FUNCTION__, status);
  1676. return status;
  1677. }
  1678. /* Clear TX and RX buffers in UMP */
  1679. status = TIPurgeDataSync (port, UMP_PORT_DIR_OUT | UMP_PORT_DIR_IN);
  1680. if (status) {
  1681. dev_err(&port->dev,"%s - cannot send clear buffers command, %d\n", __FUNCTION__, status);
  1682. return status;
  1683. }
  1684. /* Read Initial MSR */
  1685. status = TIReadVendorRequestSync (dev,
  1686. UMPC_READ_MSR, // Request
  1687. 0, // wValue
  1688. (__u16)(UMPM_UART1_PORT + port_number), // wIndex (Address)
  1689. &edge_port->shadow_msr, // TransferBuffer
  1690. 1); // TransferBufferLength
  1691. if (status) {
  1692. dev_err(&port->dev,"%s - cannot send read MSR command, %d\n", __FUNCTION__, status);
  1693. return status;
  1694. }
  1695. dbg ("ShadowMSR 0x%X", edge_port->shadow_msr);
  1696. /* Set Initial MCR */
  1697. edge_port->shadow_mcr = MCR_RTS | MCR_DTR;
  1698. dbg ("ShadowMCR 0x%X", edge_port->shadow_mcr);
  1699. edge_serial = edge_port->edge_serial;
  1700. if (down_interruptible(&edge_serial->es_sem))
  1701. return -ERESTARTSYS;
  1702. if (edge_serial->num_ports_open == 0) {
  1703. /* we are the first port to be opened, let's post the interrupt urb */
  1704. urb = edge_serial->serial->port[0]->interrupt_in_urb;
  1705. if (!urb) {
  1706. dev_err (&port->dev, "%s - no interrupt urb present, exiting\n", __FUNCTION__);
  1707. status = -EINVAL;
  1708. goto up_es_sem;
  1709. }
  1710. urb->complete = edge_interrupt_callback;
  1711. urb->context = edge_serial;
  1712. urb->dev = dev;
  1713. status = usb_submit_urb (urb, GFP_KERNEL);
  1714. if (status) {
  1715. dev_err (&port->dev, "%s - usb_submit_urb failed with value %d\n", __FUNCTION__, status);
  1716. goto up_es_sem;
  1717. }
  1718. }
  1719. /*
  1720. * reset the data toggle on the bulk endpoints to work around bug in
  1721. * host controllers where things get out of sync some times
  1722. */
  1723. usb_clear_halt (dev, port->write_urb->pipe);
  1724. usb_clear_halt (dev, port->read_urb->pipe);
  1725. /* start up our bulk read urb */
  1726. urb = port->read_urb;
  1727. if (!urb) {
  1728. dev_err (&port->dev, "%s - no read urb present, exiting\n", __FUNCTION__);
  1729. status = -EINVAL;
  1730. goto unlink_int_urb;
  1731. }
  1732. edge_port->ep_read_urb_state = EDGE_READ_URB_RUNNING;
  1733. urb->complete = edge_bulk_in_callback;
  1734. urb->context = edge_port;
  1735. urb->dev = dev;
  1736. status = usb_submit_urb (urb, GFP_KERNEL);
  1737. if (status) {
  1738. dev_err (&port->dev, "%s - read bulk usb_submit_urb failed with value %d\n", __FUNCTION__, status);
  1739. goto unlink_int_urb;
  1740. }
  1741. ++edge_serial->num_ports_open;
  1742. dbg("%s - exited", __FUNCTION__);
  1743. goto up_es_sem;
  1744. unlink_int_urb:
  1745. if (edge_port->edge_serial->num_ports_open == 0)
  1746. usb_kill_urb(port->serial->port[0]->interrupt_in_urb);
  1747. up_es_sem:
  1748. up(&edge_serial->es_sem);
  1749. return status;
  1750. }
  1751. static void edge_close (struct usb_serial_port *port, struct file *filp)
  1752. {
  1753. struct edgeport_serial *edge_serial;
  1754. struct edgeport_port *edge_port;
  1755. int port_number;
  1756. int status;
  1757. dbg("%s - port %d", __FUNCTION__, port->number);
  1758. edge_serial = usb_get_serial_data(port->serial);
  1759. edge_port = usb_get_serial_port_data(port);
  1760. if ((edge_serial == NULL) || (edge_port == NULL))
  1761. return;
  1762. /* The bulkreadcompletion routine will check
  1763. * this flag and dump add read data */
  1764. edge_port->close_pending = 1;
  1765. /* chase the port close and flush */
  1766. TIChasePort (edge_port, (HZ*closing_wait)/100, 1);
  1767. usb_kill_urb(port->read_urb);
  1768. usb_kill_urb(port->write_urb);
  1769. edge_port->ep_write_urb_in_use = 0;
  1770. /* assuming we can still talk to the device,
  1771. * send a close port command to it */
  1772. dbg("%s - send umpc_close_port", __FUNCTION__);
  1773. port_number = port->number - port->serial->minor;
  1774. status = TIWriteCommandSync (port->serial->dev,
  1775. UMPC_CLOSE_PORT,
  1776. (__u8)(UMPM_UART1_PORT + port_number),
  1777. 0,
  1778. NULL,
  1779. 0);
  1780. down(&edge_serial->es_sem);
  1781. --edge_port->edge_serial->num_ports_open;
  1782. if (edge_port->edge_serial->num_ports_open <= 0) {
  1783. /* last port is now closed, let's shut down our interrupt urb */
  1784. usb_kill_urb(port->serial->port[0]->interrupt_in_urb);
  1785. edge_port->edge_serial->num_ports_open = 0;
  1786. }
  1787. up(&edge_serial->es_sem);
  1788. edge_port->close_pending = 0;
  1789. dbg("%s - exited", __FUNCTION__);
  1790. }
  1791. static int edge_write (struct usb_serial_port *port, const unsigned char *data, int count)
  1792. {
  1793. struct edgeport_port *edge_port = usb_get_serial_port_data(port);
  1794. unsigned long flags;
  1795. dbg("%s - port %d", __FUNCTION__, port->number);
  1796. if (count == 0) {
  1797. dbg("%s - write request of 0 bytes", __FUNCTION__);
  1798. return 0;
  1799. }
  1800. if (edge_port == NULL)
  1801. return -ENODEV;
  1802. if (edge_port->close_pending == 1)
  1803. return -ENODEV;
  1804. spin_lock_irqsave(&edge_port->ep_lock, flags);
  1805. count = edge_buf_put(edge_port->ep_out_buf, data, count);
  1806. spin_unlock_irqrestore(&edge_port->ep_lock, flags);
  1807. edge_send(port);
  1808. return count;
  1809. }
  1810. static void edge_send(struct usb_serial_port *port)
  1811. {
  1812. int count, result;
  1813. struct edgeport_port *edge_port = usb_get_serial_port_data(port);
  1814. struct tty_struct *tty = port->tty;
  1815. unsigned long flags;
  1816. dbg("%s - port %d", __FUNCTION__, port->number);
  1817. spin_lock_irqsave(&edge_port->ep_lock, flags);
  1818. if (edge_port->ep_write_urb_in_use) {
  1819. spin_unlock_irqrestore(&edge_port->ep_lock, flags);
  1820. return;
  1821. }
  1822. count = edge_buf_get(edge_port->ep_out_buf,
  1823. port->write_urb->transfer_buffer,
  1824. port->bulk_out_size);
  1825. if (count == 0) {
  1826. spin_unlock_irqrestore(&edge_port->ep_lock, flags);
  1827. return;
  1828. }
  1829. edge_port->ep_write_urb_in_use = 1;
  1830. spin_unlock_irqrestore(&edge_port->ep_lock, flags);
  1831. usb_serial_debug_data(debug, &port->dev, __FUNCTION__, count, port->write_urb->transfer_buffer);
  1832. /* set up our urb */
  1833. usb_fill_bulk_urb (port->write_urb, port->serial->dev,
  1834. usb_sndbulkpipe (port->serial->dev,
  1835. port->bulk_out_endpointAddress),
  1836. port->write_urb->transfer_buffer, count,
  1837. edge_bulk_out_callback,
  1838. port);
  1839. /* send the data out the bulk port */
  1840. result = usb_submit_urb(port->write_urb, GFP_ATOMIC);
  1841. if (result) {
  1842. dev_err(&port->dev, "%s - failed submitting write urb, error %d\n", __FUNCTION__, result);
  1843. edge_port->ep_write_urb_in_use = 0;
  1844. // TODO: reschedule edge_send
  1845. } else {
  1846. edge_port->icount.tx += count;
  1847. }
  1848. /* wakeup any process waiting for writes to complete */
  1849. /* there is now more room in the buffer for new writes */
  1850. if (tty) {
  1851. /* let the tty driver wakeup if it has a special write_wakeup function */
  1852. tty_wakeup(tty);
  1853. }
  1854. }
  1855. static int edge_write_room (struct usb_serial_port *port)
  1856. {
  1857. struct edgeport_port *edge_port = usb_get_serial_port_data(port);
  1858. int room = 0;
  1859. unsigned long flags;
  1860. dbg("%s - port %d", __FUNCTION__, port->number);
  1861. if (edge_port == NULL)
  1862. return -ENODEV;
  1863. if (edge_port->close_pending == 1)
  1864. return -ENODEV;
  1865. spin_lock_irqsave(&edge_port->ep_lock, flags);
  1866. room = edge_buf_space_avail(edge_port->ep_out_buf);
  1867. spin_unlock_irqrestore(&edge_port->ep_lock, flags);
  1868. dbg("%s - returns %d", __FUNCTION__, room);
  1869. return room;
  1870. }
  1871. static int edge_chars_in_buffer (struct usb_serial_port *port)
  1872. {
  1873. struct edgeport_port *edge_port = usb_get_serial_port_data(port);
  1874. int chars = 0;
  1875. unsigned long flags;
  1876. dbg("%s - port %d", __FUNCTION__, port->number);
  1877. if (edge_port == NULL)
  1878. return -ENODEV;
  1879. if (edge_port->close_pending == 1)
  1880. return -ENODEV;
  1881. spin_lock_irqsave(&edge_port->ep_lock, flags);
  1882. chars = edge_buf_data_avail(edge_port->ep_out_buf);
  1883. spin_unlock_irqrestore(&edge_port->ep_lock, flags);
  1884. dbg ("%s - returns %d", __FUNCTION__, chars);
  1885. return chars;
  1886. }
  1887. static void edge_throttle (struct usb_serial_port *port)
  1888. {
  1889. struct edgeport_port *edge_port = usb_get_serial_port_data(port);
  1890. struct tty_struct *tty;
  1891. int status;
  1892. dbg("%s - port %d", __FUNCTION__, port->number);
  1893. if (edge_port == NULL)
  1894. return;
  1895. tty = port->tty;
  1896. if (!tty) {
  1897. dbg ("%s - no tty available", __FUNCTION__);
  1898. return;
  1899. }
  1900. /* if we are implementing XON/XOFF, send the stop character */
  1901. if (I_IXOFF(tty)) {
  1902. unsigned char stop_char = STOP_CHAR(tty);
  1903. status = edge_write (port, &stop_char, 1);
  1904. if (status <= 0) {
  1905. dev_err(&port->dev, "%s - failed to write stop character, %d\n", __FUNCTION__, status);
  1906. }
  1907. }
  1908. /* if we are implementing RTS/CTS, stop reads */
  1909. /* and the Edgeport will clear the RTS line */
  1910. if (C_CRTSCTS(tty))
  1911. stop_read(edge_port);
  1912. }
  1913. static void edge_unthrottle (struct usb_serial_port *port)
  1914. {
  1915. struct edgeport_port *edge_port = usb_get_serial_port_data(port);
  1916. struct tty_struct *tty;
  1917. int status;
  1918. dbg("%s - port %d", __FUNCTION__, port->number);
  1919. if (edge_port == NULL)
  1920. return;
  1921. tty = port->tty;
  1922. if (!tty) {
  1923. dbg ("%s - no tty available", __FUNCTION__);
  1924. return;
  1925. }
  1926. /* if we are implementing XON/XOFF, send the start character */
  1927. if (I_IXOFF(tty)) {
  1928. unsigned char start_char = START_CHAR(tty);
  1929. status = edge_write (port, &start_char, 1);
  1930. if (status <= 0) {
  1931. dev_err(&port->dev, "%s - failed to write start character, %d\n", __FUNCTION__, status);
  1932. }
  1933. }
  1934. /* if we are implementing RTS/CTS, restart reads */
  1935. /* are the Edgeport will assert the RTS line */
  1936. if (C_CRTSCTS(tty)) {
  1937. status = restart_read(edge_port);
  1938. if (status)
  1939. dev_err(&port->dev, "%s - read bulk usb_submit_urb failed with value %d\n", __FUNCTION__, status);
  1940. }
  1941. }
  1942. static void stop_read(struct edgeport_port *edge_port)
  1943. {
  1944. unsigned long flags;
  1945. spin_lock_irqsave(&edge_port->ep_lock, flags);
  1946. if (edge_port->ep_read_urb_state == EDGE_READ_URB_RUNNING)
  1947. edge_port->ep_read_urb_state = EDGE_READ_URB_STOPPING;
  1948. edge_port->shadow_mcr &= ~MCR_RTS;
  1949. spin_unlock_irqrestore(&edge_port->ep_lock, flags);
  1950. }
  1951. static int restart_read(struct edgeport_port *edge_port)
  1952. {
  1953. struct urb *urb;
  1954. int status = 0;
  1955. unsigned long flags;
  1956. spin_lock_irqsave(&edge_port->ep_lock, flags);
  1957. if (edge_port->ep_read_urb_state == EDGE_READ_URB_STOPPED) {
  1958. urb = edge_port->port->read_urb;
  1959. urb->complete = edge_bulk_in_callback;
  1960. urb->context = edge_port;
  1961. urb->dev = edge_port->port->serial->dev;
  1962. status = usb_submit_urb(urb, GFP_KERNEL);
  1963. }
  1964. edge_port->ep_read_urb_state = EDGE_READ_URB_RUNNING;
  1965. edge_port->shadow_mcr |= MCR_RTS;
  1966. spin_unlock_irqrestore(&edge_port->ep_lock, flags);
  1967. return status;
  1968. }
  1969. static void change_port_settings (struct edgeport_port *edge_port, struct termios *old_termios)
  1970. {
  1971. struct ump_uart_config *config;
  1972. struct tty_struct *tty;
  1973. int baud;
  1974. unsigned cflag;
  1975. int status;
  1976. int port_number = edge_port->port->number - edge_port->port->serial->minor;
  1977. dbg("%s - port %d", __FUNCTION__, edge_port->port->number);
  1978. tty = edge_port->port->tty;
  1979. if ((!tty) ||
  1980. (!tty->termios)) {
  1981. dbg("%s - no tty structures", __FUNCTION__);
  1982. return;
  1983. }
  1984. config = kmalloc (sizeof (*config), GFP_KERNEL);
  1985. if (!config) {
  1986. dev_err (&edge_port->port->dev, "%s - out of memory\n", __FUNCTION__);
  1987. return;
  1988. }
  1989. cflag = tty->termios->c_cflag;
  1990. config->wFlags = 0;
  1991. /* These flags must be set */
  1992. config->wFlags |= UMP_MASK_UART_FLAGS_RECEIVE_MS_INT;
  1993. config->wFlags |= UMP_MASK_UART_FLAGS_AUTO_START_ON_ERR;
  1994. config->bUartMode = (__u8)(edge_port->bUartMode);
  1995. switch (cflag & CSIZE) {
  1996. case CS5:
  1997. config->bDataBits = UMP_UART_CHAR5BITS;
  1998. dbg ("%s - data bits = 5", __FUNCTION__);
  1999. break;
  2000. case CS6:
  2001. config->bDataBits = UMP_UART_CHAR6BITS;
  2002. dbg ("%s - data bits = 6", __FUNCTION__);
  2003. break;
  2004. case CS7:
  2005. config->bDataBits = UMP_UART_CHAR7BITS;
  2006. dbg ("%s - data bits = 7", __FUNCTION__);
  2007. break;
  2008. default:
  2009. case CS8:
  2010. config->bDataBits = UMP_UART_CHAR8BITS;
  2011. dbg ("%s - data bits = 8", __FUNCTION__);
  2012. break;
  2013. }
  2014. if (cflag & PARENB) {
  2015. if (cflag & PARODD) {
  2016. config->wFlags |= UMP_MASK_UART_FLAGS_PARITY;
  2017. config->bParity = UMP_UART_ODDPARITY;
  2018. dbg("%s - parity = odd", __FUNCTION__);
  2019. } else {
  2020. config->wFlags |= UMP_MASK_UART_FLAGS_PARITY;
  2021. config->bParity = UMP_UART_EVENPARITY;
  2022. dbg("%s - parity = even", __FUNCTION__);
  2023. }
  2024. } else {
  2025. config->bParity = UMP_UART_NOPARITY;
  2026. dbg("%s - parity = none", __FUNCTION__);
  2027. }
  2028. if (cflag & CSTOPB) {
  2029. config->bStopBits = UMP_UART_STOPBIT2;
  2030. dbg("%s - stop bits = 2", __FUNCTION__);
  2031. } else {
  2032. config->bStopBits = UMP_UART_STOPBIT1;
  2033. dbg("%s - stop bits = 1", __FUNCTION__);
  2034. }
  2035. /* figure out the flow control settings */
  2036. if (cflag & CRTSCTS) {
  2037. config->wFlags |= UMP_MASK_UART_FLAGS_OUT_X_CTS_FLOW;
  2038. config->wFlags |= UMP_MASK_UART_FLAGS_RTS_FLOW;
  2039. dbg("%s - RTS/CTS is enabled", __FUNCTION__);
  2040. } else {
  2041. dbg("%s - RTS/CTS is disabled", __FUNCTION__);
  2042. tty->hw_stopped = 0;
  2043. restart_read(edge_port);
  2044. }
  2045. /* if we are implementing XON/XOFF, set the start and stop character in the device */
  2046. if (I_IXOFF(tty) || I_IXON(tty)) {
  2047. config->cXon = START_CHAR(tty);
  2048. config->cXoff = STOP_CHAR(tty);
  2049. /* if we are implementing INBOUND XON/XOFF */
  2050. if (I_IXOFF(tty)) {
  2051. config->wFlags |= UMP_MASK_UART_FLAGS_IN_X;
  2052. dbg ("%s - INBOUND XON/XOFF is enabled, XON = %2x, XOFF = %2x",
  2053. __FUNCTION__, config->cXon, config->cXoff);
  2054. } else {
  2055. dbg ("%s - INBOUND XON/XOFF is disabled", __FUNCTION__);
  2056. }
  2057. /* if we are implementing OUTBOUND XON/XOFF */
  2058. if (I_IXON(tty)) {
  2059. config->wFlags |= UMP_MASK_UART_FLAGS_OUT_X;
  2060. dbg ("%s - OUTBOUND XON/XOFF is enabled, XON = %2x, XOFF = %2x",
  2061. __FUNCTION__, config->cXon, config->cXoff);
  2062. } else {
  2063. dbg ("%s - OUTBOUND XON/XOFF is disabled", __FUNCTION__);
  2064. }
  2065. }
  2066. /* Round the baud rate */
  2067. baud = tty_get_baud_rate(tty);
  2068. if (!baud) {
  2069. /* pick a default, any default... */
  2070. baud = 9600;
  2071. }
  2072. edge_port->baud_rate = baud;
  2073. config->wBaudRate = (__u16)((461550L + baud/2) / baud);
  2074. dbg ("%s - baud rate = %d, wBaudRate = %d", __FUNCTION__, baud, config->wBaudRate);
  2075. dbg ("wBaudRate: %d", (int)(461550L / config->wBaudRate));
  2076. dbg ("wFlags: 0x%x", config->wFlags);
  2077. dbg ("bDataBits: %d", config->bDataBits);
  2078. dbg ("bParity: %d", config->bParity);
  2079. dbg ("bStopBits: %d", config->bStopBits);
  2080. dbg ("cXon: %d", config->cXon);
  2081. dbg ("cXoff: %d", config->cXoff);
  2082. dbg ("bUartMode: %d", config->bUartMode);
  2083. /* move the word values into big endian mode */
  2084. cpu_to_be16s (&config->wFlags);
  2085. cpu_to_be16s (&config->wBaudRate);
  2086. status = TIWriteCommandSync (edge_port->port->serial->dev,
  2087. UMPC_SET_CONFIG,
  2088. (__u8)(UMPM_UART1_PORT + port_number),
  2089. 0,
  2090. (__u8 *)config,
  2091. sizeof(*config));
  2092. if (status) {
  2093. dbg ("%s - error %d when trying to write config to device",
  2094. __FUNCTION__, status);
  2095. }
  2096. kfree (config);
  2097. return;
  2098. }
  2099. static void edge_set_termios (struct usb_serial_port *port, struct termios *old_termios)
  2100. {
  2101. struct edgeport_port *edge_port = usb_get_serial_port_data(port);
  2102. struct tty_struct *tty = port->tty;
  2103. unsigned int cflag;
  2104. if (!port->tty || !port->tty->termios) {
  2105. dbg ("%s - no tty or termios", __FUNCTION__);
  2106. return;
  2107. }
  2108. cflag = tty->termios->c_cflag;
  2109. /* check that they really want us to change something */
  2110. if (old_termios) {
  2111. if (cflag == old_termios->c_cflag &&
  2112. tty->termios->c_iflag == old_termios->c_iflag) {
  2113. dbg ("%s - nothing to change", __FUNCTION__);
  2114. return;
  2115. }
  2116. }
  2117. dbg("%s - clfag %08x iflag %08x", __FUNCTION__,
  2118. tty->termios->c_cflag, tty->termios->c_iflag);
  2119. if (old_termios) {
  2120. dbg("%s - old clfag %08x old iflag %08x", __FUNCTION__,
  2121. old_termios->c_cflag, old_termios->c_iflag);
  2122. }
  2123. dbg("%s - port %d", __FUNCTION__, port->number);
  2124. if (edge_port == NULL)
  2125. return;
  2126. /* change the port settings to the new ones specified */
  2127. change_port_settings (edge_port, old_termios);
  2128. return;
  2129. }
  2130. static int edge_tiocmset (struct usb_serial_port *port, struct file *file, unsigned int set, unsigned int clear)
  2131. {
  2132. struct edgeport_port *edge_port = usb_get_serial_port_data(port);
  2133. unsigned int mcr;
  2134. dbg("%s - port %d", __FUNCTION__, port->number);
  2135. mcr = edge_port->shadow_mcr;
  2136. if (set & TIOCM_RTS)
  2137. mcr |= MCR_RTS;
  2138. if (set & TIOCM_DTR)
  2139. mcr |= MCR_DTR;
  2140. if (set & TIOCM_LOOP)
  2141. mcr |= MCR_LOOPBACK;
  2142. if (clear & TIOCM_RTS)
  2143. mcr &= ~MCR_RTS;
  2144. if (clear & TIOCM_DTR)
  2145. mcr &= ~MCR_DTR;
  2146. if (clear & TIOCM_LOOP)
  2147. mcr &= ~MCR_LOOPBACK;
  2148. edge_port->shadow_mcr = mcr;
  2149. TIRestoreMCR (edge_port, mcr);
  2150. return 0;
  2151. }
  2152. static int edge_tiocmget(struct usb_serial_port *port, struct file *file)
  2153. {
  2154. struct edgeport_port *edge_port = usb_get_serial_port_data(port);
  2155. unsigned int result = 0;
  2156. unsigned int msr;
  2157. unsigned int mcr;
  2158. dbg("%s - port %d", __FUNCTION__, port->number);
  2159. msr = edge_port->shadow_msr;
  2160. mcr = edge_port->shadow_mcr;
  2161. result = ((mcr & MCR_DTR) ? TIOCM_DTR: 0) /* 0x002 */
  2162. | ((mcr & MCR_RTS) ? TIOCM_RTS: 0) /* 0x004 */
  2163. | ((msr & EDGEPORT_MSR_CTS) ? TIOCM_CTS: 0) /* 0x020 */
  2164. | ((msr & EDGEPORT_MSR_CD) ? TIOCM_CAR: 0) /* 0x040 */
  2165. | ((msr & EDGEPORT_MSR_RI) ? TIOCM_RI: 0) /* 0x080 */
  2166. | ((msr & EDGEPORT_MSR_DSR) ? TIOCM_DSR: 0); /* 0x100 */
  2167. dbg("%s -- %x", __FUNCTION__, result);
  2168. return result;
  2169. }
  2170. static int get_serial_info (struct edgeport_port *edge_port, struct serial_struct __user *retinfo)
  2171. {
  2172. struct serial_struct tmp;
  2173. if (!retinfo)
  2174. return -EFAULT;
  2175. memset(&tmp, 0, sizeof(tmp));
  2176. tmp.type = PORT_16550A;
  2177. tmp.line = edge_port->port->serial->minor;
  2178. tmp.port = edge_port->port->number;
  2179. tmp.irq = 0;
  2180. tmp.flags = ASYNC_SKIP_TEST | ASYNC_AUTO_IRQ;
  2181. tmp.xmit_fifo_size = edge_port->port->bulk_out_size;
  2182. tmp.baud_base = 9600;
  2183. tmp.close_delay = 5*HZ;
  2184. tmp.closing_wait = closing_wait;
  2185. // tmp.custom_divisor = state->custom_divisor;
  2186. // tmp.hub6 = state->hub6;
  2187. // tmp.io_type = state->io_type;
  2188. if (copy_to_user(retinfo, &tmp, sizeof(*retinfo)))
  2189. return -EFAULT;
  2190. return 0;
  2191. }
  2192. static int edge_ioctl (struct usb_serial_port *port, struct file *file, unsigned int cmd, unsigned long arg)
  2193. {
  2194. struct edgeport_port *edge_port = usb_get_serial_port_data(port);
  2195. struct async_icount cnow;
  2196. struct async_icount cprev;
  2197. dbg("%s - port %d, cmd = 0x%x", __FUNCTION__, port->number, cmd);
  2198. switch (cmd) {
  2199. case TIOCINQ:
  2200. dbg("%s - (%d) TIOCINQ", __FUNCTION__, port->number);
  2201. // return get_number_bytes_avail(edge_port, (unsigned int *) arg);
  2202. break;
  2203. case TIOCSERGETLSR:
  2204. dbg("%s - (%d) TIOCSERGETLSR", __FUNCTION__, port->number);
  2205. // return get_lsr_info(edge_port, (unsigned int *) arg);
  2206. break;
  2207. case TIOCGSERIAL:
  2208. dbg("%s - (%d) TIOCGSERIAL", __FUNCTION__, port->number);
  2209. return get_serial_info(edge_port, (struct serial_struct __user *) arg);
  2210. break;
  2211. case TIOCSSERIAL:
  2212. dbg("%s - (%d) TIOCSSERIAL", __FUNCTION__, port->number);
  2213. break;
  2214. case TIOCMIWAIT:
  2215. dbg("%s - (%d) TIOCMIWAIT", __FUNCTION__, port->number);
  2216. cprev = edge_port->icount;
  2217. while (1) {
  2218. interruptible_sleep_on(&edge_port->delta_msr_wait);
  2219. /* see if a signal did it */
  2220. if (signal_pending(current))
  2221. return -ERESTARTSYS;
  2222. cnow = edge_port->icount;
  2223. if (cnow.rng == cprev.rng && cnow.dsr == cprev.dsr &&
  2224. cnow.dcd == cprev.dcd && cnow.cts == cprev.cts)
  2225. return -EIO; /* no change => error */
  2226. if (((arg & TIOCM_RNG) && (cnow.rng != cprev.rng)) ||
  2227. ((arg & TIOCM_DSR) && (cnow.dsr != cprev.dsr)) ||
  2228. ((arg & TIOCM_CD) && (cnow.dcd != cprev.dcd)) ||
  2229. ((arg & TIOCM_CTS) && (cnow.cts != cprev.cts)) ) {
  2230. return 0;
  2231. }
  2232. cprev = cnow;
  2233. }
  2234. /* not reached */
  2235. break;
  2236. case TIOCGICOUNT:
  2237. dbg ("%s - (%d) TIOCGICOUNT RX=%d, TX=%d", __FUNCTION__,
  2238. port->number, edge_port->icount.rx, edge_port->icount.tx);
  2239. if (copy_to_user((void __user *)arg, &edge_port->icount, sizeof(edge_port->icount)))
  2240. return -EFAULT;
  2241. return 0;
  2242. }
  2243. return -ENOIOCTLCMD;
  2244. }
  2245. static void edge_break (struct usb_serial_port *port, int break_state)
  2246. {
  2247. struct edgeport_port *edge_port = usb_get_serial_port_data(port);
  2248. int status;
  2249. dbg ("%s - state = %d", __FUNCTION__, break_state);
  2250. /* chase the port close */
  2251. TIChasePort (edge_port, 0, 0);
  2252. if (break_state == -1) {
  2253. status = TISetBreak (edge_port);
  2254. } else {
  2255. status = TIClearBreak (edge_port);
  2256. }
  2257. if (status) {
  2258. dbg ("%s - error %d sending break set/clear command.",
  2259. __FUNCTION__, status);
  2260. }
  2261. }
  2262. static int edge_startup (struct usb_serial *serial)
  2263. {
  2264. struct edgeport_serial *edge_serial;
  2265. struct edgeport_port *edge_port;
  2266. struct usb_device *dev;
  2267. int status;
  2268. int i;
  2269. dev = serial->dev;
  2270. /* create our private serial structure */
  2271. edge_serial = kzalloc(sizeof(struct edgeport_serial), GFP_KERNEL);
  2272. if (edge_serial == NULL) {
  2273. dev_err(&serial->dev->dev, "%s - Out of memory\n", __FUNCTION__);
  2274. return -ENOMEM;
  2275. }
  2276. sema_init(&edge_serial->es_sem, 1);
  2277. edge_serial->serial = serial;
  2278. usb_set_serial_data(serial, edge_serial);
  2279. status = TIDownloadFirmware (edge_serial);
  2280. if (status) {
  2281. kfree (edge_serial);
  2282. return status;
  2283. }
  2284. /* set up our port private structures */
  2285. for (i = 0; i < serial->num_ports; ++i) {
  2286. edge_port = kzalloc(sizeof(struct edgeport_port), GFP_KERNEL);
  2287. if (edge_port == NULL) {
  2288. dev_err(&serial->dev->dev, "%s - Out of memory\n", __FUNCTION__);
  2289. goto cleanup;
  2290. }
  2291. spin_lock_init(&edge_port->ep_lock);
  2292. edge_port->ep_out_buf = edge_buf_alloc(EDGE_OUT_BUF_SIZE);
  2293. if (edge_port->ep_out_buf == NULL) {
  2294. dev_err(&serial->dev->dev, "%s - Out of memory\n", __FUNCTION__);
  2295. kfree(edge_port);
  2296. goto cleanup;
  2297. }
  2298. edge_port->port = serial->port[i];
  2299. edge_port->edge_serial = edge_serial;
  2300. usb_set_serial_port_data(serial->port[i], edge_port);
  2301. edge_port->bUartMode = 0; /* Default is RS232 */
  2302. }
  2303. return 0;
  2304. cleanup:
  2305. for (--i; i>=0; --i) {
  2306. edge_port = usb_get_serial_port_data(serial->port[i]);
  2307. edge_buf_free(edge_port->ep_out_buf);
  2308. kfree(edge_port);
  2309. usb_set_serial_port_data(serial->port[i], NULL);
  2310. }
  2311. kfree (edge_serial);
  2312. usb_set_serial_data(serial, NULL);
  2313. return -ENOMEM;
  2314. }
  2315. static void edge_shutdown (struct usb_serial *serial)
  2316. {
  2317. int i;
  2318. struct edgeport_port *edge_port;
  2319. dbg ("%s", __FUNCTION__);
  2320. for (i=0; i < serial->num_ports; ++i) {
  2321. edge_port = usb_get_serial_port_data(serial->port[i]);
  2322. if (edge_port) {
  2323. edge_buf_free(edge_port->ep_out_buf);
  2324. kfree(edge_port);
  2325. }
  2326. usb_set_serial_port_data(serial->port[i], NULL);
  2327. }
  2328. kfree (usb_get_serial_data(serial));
  2329. usb_set_serial_data(serial, NULL);
  2330. }
  2331. /* Circular Buffer */
  2332. /*
  2333. * edge_buf_alloc
  2334. *
  2335. * Allocate a circular buffer and all associated memory.
  2336. */
  2337. static struct edge_buf *edge_buf_alloc(unsigned int size)
  2338. {
  2339. struct edge_buf *eb;
  2340. if (size == 0)
  2341. return NULL;
  2342. eb = (struct edge_buf *)kmalloc(sizeof(struct edge_buf), GFP_KERNEL);
  2343. if (eb == NULL)
  2344. return NULL;
  2345. eb->buf_buf = kmalloc(size, GFP_KERNEL);
  2346. if (eb->buf_buf == NULL) {
  2347. kfree(eb);
  2348. return NULL;
  2349. }
  2350. eb->buf_size = size;
  2351. eb->buf_get = eb->buf_put = eb->buf_buf;
  2352. return eb;
  2353. }
  2354. /*
  2355. * edge_buf_free
  2356. *
  2357. * Free the buffer and all associated memory.
  2358. */
  2359. static void edge_buf_free(struct edge_buf *eb)
  2360. {
  2361. if (eb) {
  2362. kfree(eb->buf_buf);
  2363. kfree(eb);
  2364. }
  2365. }
  2366. /*
  2367. * edge_buf_clear
  2368. *
  2369. * Clear out all data in the circular buffer.
  2370. */
  2371. static void edge_buf_clear(struct edge_buf *eb)
  2372. {
  2373. if (eb != NULL)
  2374. eb->buf_get = eb->buf_put;
  2375. /* equivalent to a get of all data available */
  2376. }
  2377. /*
  2378. * edge_buf_data_avail
  2379. *
  2380. * Return the number of bytes of data available in the circular
  2381. * buffer.
  2382. */
  2383. static unsigned int edge_buf_data_avail(struct edge_buf *eb)
  2384. {
  2385. if (eb != NULL)
  2386. return ((eb->buf_size + eb->buf_put - eb->buf_get) % eb->buf_size);
  2387. else
  2388. return 0;
  2389. }
  2390. /*
  2391. * edge_buf_space_avail
  2392. *
  2393. * Return the number of bytes of space available in the circular
  2394. * buffer.
  2395. */
  2396. static unsigned int edge_buf_space_avail(struct edge_buf *eb)
  2397. {
  2398. if (eb != NULL)
  2399. return ((eb->buf_size + eb->buf_get - eb->buf_put - 1) % eb->buf_size);
  2400. else
  2401. return 0;
  2402. }
  2403. /*
  2404. * edge_buf_put
  2405. *
  2406. * Copy data data from a user buffer and put it into the circular buffer.
  2407. * Restrict to the amount of space available.
  2408. *
  2409. * Return the number of bytes copied.
  2410. */
  2411. static unsigned int edge_buf_put(struct edge_buf *eb, const char *buf,
  2412. unsigned int count)
  2413. {
  2414. unsigned int len;
  2415. if (eb == NULL)
  2416. return 0;
  2417. len = edge_buf_space_avail(eb);
  2418. if (count > len)
  2419. count = len;
  2420. if (count == 0)
  2421. return 0;
  2422. len = eb->buf_buf + eb->buf_size - eb->buf_put;
  2423. if (count > len) {
  2424. memcpy(eb->buf_put, buf, len);
  2425. memcpy(eb->buf_buf, buf+len, count - len);
  2426. eb->buf_put = eb->buf_buf + count - len;
  2427. } else {
  2428. memcpy(eb->buf_put, buf, count);
  2429. if (count < len)
  2430. eb->buf_put += count;
  2431. else /* count == len */
  2432. eb->buf_put = eb->buf_buf;
  2433. }
  2434. return count;
  2435. }
  2436. /*
  2437. * edge_buf_get
  2438. *
  2439. * Get data from the circular buffer and copy to the given buffer.
  2440. * Restrict to the amount of data available.
  2441. *
  2442. * Return the number of bytes copied.
  2443. */
  2444. static unsigned int edge_buf_get(struct edge_buf *eb, char *buf,
  2445. unsigned int count)
  2446. {
  2447. unsigned int len;
  2448. if (eb == NULL)
  2449. return 0;
  2450. len = edge_buf_data_avail(eb);
  2451. if (count > len)
  2452. count = len;
  2453. if (count == 0)
  2454. return 0;
  2455. len = eb->buf_buf + eb->buf_size - eb->buf_get;
  2456. if (count > len) {
  2457. memcpy(buf, eb->buf_get, len);
  2458. memcpy(buf+len, eb->buf_buf, count - len);
  2459. eb->buf_get = eb->buf_buf + count - len;
  2460. } else {
  2461. memcpy(buf, eb->buf_get, count);
  2462. if (count < len)
  2463. eb->buf_get += count;
  2464. else /* count == len */
  2465. eb->buf_get = eb->buf_buf;
  2466. }
  2467. return count;
  2468. }
  2469. static struct usb_serial_driver edgeport_1port_device = {
  2470. .driver = {
  2471. .owner = THIS_MODULE,
  2472. .name = "edgeport_ti_1",
  2473. },
  2474. .description = "Edgeport TI 1 port adapter",
  2475. .id_table = edgeport_1port_id_table,
  2476. .num_interrupt_in = 1,
  2477. .num_bulk_in = 1,
  2478. .num_bulk_out = 1,
  2479. .num_ports = 1,
  2480. .open = edge_open,
  2481. .close = edge_close,
  2482. .throttle = edge_throttle,
  2483. .unthrottle = edge_unthrottle,
  2484. .attach = edge_startup,
  2485. .shutdown = edge_shutdown,
  2486. .ioctl = edge_ioctl,
  2487. .set_termios = edge_set_termios,
  2488. .tiocmget = edge_tiocmget,
  2489. .tiocmset = edge_tiocmset,
  2490. .write = edge_write,
  2491. .write_room = edge_write_room,
  2492. .chars_in_buffer = edge_chars_in_buffer,
  2493. .break_ctl = edge_break,
  2494. .read_int_callback = edge_interrupt_callback,
  2495. .read_bulk_callback = edge_bulk_in_callback,
  2496. .write_bulk_callback = edge_bulk_out_callback,
  2497. };
  2498. static struct usb_serial_driver edgeport_2port_device = {
  2499. .driver = {
  2500. .owner = THIS_MODULE,
  2501. .name = "edgeport_ti_2",
  2502. },
  2503. .description = "Edgeport TI 2 port adapter",
  2504. .id_table = edgeport_2port_id_table,
  2505. .num_interrupt_in = 1,
  2506. .num_bulk_in = 2,
  2507. .num_bulk_out = 2,
  2508. .num_ports = 2,
  2509. .open = edge_open,
  2510. .close = edge_close,
  2511. .throttle = edge_throttle,
  2512. .unthrottle = edge_unthrottle,
  2513. .attach = edge_startup,
  2514. .shutdown = edge_shutdown,
  2515. .ioctl = edge_ioctl,
  2516. .set_termios = edge_set_termios,
  2517. .tiocmget = edge_tiocmget,
  2518. .tiocmset = edge_tiocmset,
  2519. .write = edge_write,
  2520. .write_room = edge_write_room,
  2521. .chars_in_buffer = edge_chars_in_buffer,
  2522. .break_ctl = edge_break,
  2523. .read_int_callback = edge_interrupt_callback,
  2524. .read_bulk_callback = edge_bulk_in_callback,
  2525. .write_bulk_callback = edge_bulk_out_callback,
  2526. };
  2527. static int __init edgeport_init(void)
  2528. {
  2529. int retval;
  2530. retval = usb_serial_register(&edgeport_1port_device);
  2531. if (retval)
  2532. goto failed_1port_device_register;
  2533. retval = usb_serial_register(&edgeport_2port_device);
  2534. if (retval)
  2535. goto failed_2port_device_register;
  2536. retval = usb_register(&io_driver);
  2537. if (retval)
  2538. goto failed_usb_register;
  2539. info(DRIVER_DESC " " DRIVER_VERSION);
  2540. return 0;
  2541. failed_usb_register:
  2542. usb_serial_deregister(&edgeport_2port_device);
  2543. failed_2port_device_register:
  2544. usb_serial_deregister(&edgeport_1port_device);
  2545. failed_1port_device_register:
  2546. return retval;
  2547. }
  2548. static void __exit edgeport_exit (void)
  2549. {
  2550. usb_deregister (&io_driver);
  2551. usb_serial_deregister (&edgeport_1port_device);
  2552. usb_serial_deregister (&edgeport_2port_device);
  2553. }
  2554. module_init(edgeport_init);
  2555. module_exit(edgeport_exit);
  2556. /* Module information */
  2557. MODULE_AUTHOR(DRIVER_AUTHOR);
  2558. MODULE_DESCRIPTION(DRIVER_DESC);
  2559. MODULE_LICENSE("GPL");
  2560. module_param(debug, bool, S_IRUGO | S_IWUSR);
  2561. MODULE_PARM_DESC(debug, "Debug enabled or not");
  2562. module_param(low_latency, bool, S_IRUGO | S_IWUSR);
  2563. MODULE_PARM_DESC(low_latency, "Low latency enabled or not");
  2564. module_param(closing_wait, int, S_IRUGO | S_IWUSR);
  2565. MODULE_PARM_DESC(closing_wait, "Maximum wait for data to drain, in .01 secs");
  2566. module_param(ignore_cpu_rev, bool, S_IRUGO | S_IWUSR);
  2567. MODULE_PARM_DESC(ignore_cpu_rev, "Ignore the cpu revision when connecting to a device");