2 * pti.c - PTI driver for cJTAG data extration
4 * Copyright (C) Intel 2010
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
15 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
17 * The PTI (Parallel Trace Interface) driver directs trace data routed from
18 * various parts in the system out through the Intel Penwell PTI port and
19 * out of the mobile device for analysis with a debugging tool
20 * (Lauterbach, Fido). This is part of a solution for the MIPI P1149.7,
21 * compact JTAG, standard.
24 #include <linux/init.h>
25 #include <linux/sched.h>
26 #include <linux/interrupt.h>
27 #include <linux/console.h>
28 #include <linux/kernel.h>
29 #include <linux/module.h>
30 #include <linux/tty.h>
31 #include <linux/tty_driver.h>
32 #include <linux/pci.h>
33 #include <linux/mutex.h>
34 #include <linux/miscdevice.h>
35 #include <linux/pti.h>
37 #define DRIVERNAME "pti"
38 #define PCINAME "pciPTI"
39 #define TTYNAME "ttyPTI"
40 #define CHARNAME "pti"
41 #define PTITTY_MINOR_START 0
42 #define PTITTY_MINOR_NUM 2
43 #define MAX_APP_IDS 16 /* 128 channel ids / u8 bit size */
44 #define MAX_OS_IDS 16 /* 128 channel ids / u8 bit size */
45 #define MAX_MODEM_IDS 16 /* 128 channel ids / u8 bit size */
46 #define MODEM_BASE_ID 71 /* modem master ID address */
47 #define CONTROL_ID 72 /* control master ID address */
48 #define CONSOLE_ID 73 /* console master ID address */
49 #define OS_BASE_ID 74 /* base OS master ID address */
50 #define APP_BASE_ID 80 /* base App master ID address */
51 #define CONTROL_FRAME_LEN 32 /* PTI control frame maximum size */
52 #define USER_COPY_SIZE 8192 /* 8Kb buffer for user space copy */
53 #define APERTURE_14 0x3800000 /* offset to first OS write addr */
54 #define APERTURE_LEN 0x400000 /* address length */
57 struct pti_masterchannel
*mc
;
62 unsigned long pti_addr
;
63 unsigned long aperture_base
;
64 void __iomem
*pti_ioaddr
;
65 u8 ia_app
[MAX_APP_IDS
];
67 u8 ia_modem
[MAX_MODEM_IDS
];
71 * This protects access to ia_app, ia_os, and ia_modem,
72 * which keeps track of channels allocated in
73 * an aperture write id.
75 static DEFINE_MUTEX(alloclock
);
77 static struct pci_device_id pci_ids
[] __devinitconst
= {
78 {PCI_DEVICE(PCI_VENDOR_ID_INTEL
, 0x82B)},
82 static struct tty_driver
*pti_tty_driver
;
83 static struct pti_dev
*drv_data
;
85 static unsigned int pti_console_channel
;
86 static unsigned int pti_control_channel
;
89 * pti_write_to_aperture()- The private write function to PTI HW.
91 * @mc: The 'aperture'. It's part of a write address that holds
92 * a master and channel ID.
93 * @buf: Data being written to the HW that will ultimately be seen
94 * in a debugging tool (Fido, Lauterbach).
95 * @len: Size of buffer.
97 * Since each aperture is specified by a unique
98 * master/channel ID, no two processes will be writing
99 * to the same aperture at the same time so no lock is required. The
100 * PTI-Output agent will send these out in the order that they arrived, and
101 * thus, it will intermix these messages. The debug tool can then later
102 * regroup the appropriate message segments together reconstituting each
105 static void pti_write_to_aperture(struct pti_masterchannel
*mc
,
113 u32 __iomem
*aperture
;
117 * calculate the aperture offset from the base using the master and
120 aperture
= drv_data
->pti_ioaddr
+ (mc
->master
<< 15)
121 + (mc
->channel
<< 8);
124 final
= len
- (dwordcnt
<< 2); /* final = trailing bytes */
125 if (final
== 0 && dwordcnt
!= 0) { /* always need a final dword */
130 for (i
= 0; i
< dwordcnt
; i
++) {
131 ptiword
= be32_to_cpu(*(u32
*)p
);
133 iowrite32(ptiword
, aperture
);
136 aperture
+= PTI_LASTDWORD_DTS
; /* adding DTS signals that is EOM */
139 for (i
= 0; i
< final
; i
++)
140 ptiword
|= *p
++ << (24-(8*i
));
142 iowrite32(ptiword
, aperture
);
147 * pti_control_frame_built_and_sent()- control frame build and send function.
149 * @mc: The master / channel structure on which the function
150 * built a control frame.
151 * @thread_name: The thread name associated with the master / channel or
152 * 'NULL' if using the 'current' global variable.
154 * To be able to post process the PTI contents on host side, a control frame
155 * is added before sending any PTI content. So the host side knows on
156 * each PTI frame the name of the thread using a dedicated master / channel.
157 * The thread name is retrieved from 'current' global variable if 'thread_name'
158 * is 'NULL', else it is retrieved from 'thread_name' parameter.
159 * This function builds this frame and sends it to a master ID CONTROL_ID.
160 * The overhead is only 32 bytes since the driver only writes to HW
163 static void pti_control_frame_built_and_sent(struct pti_masterchannel
*mc
,
164 const char *thread_name
)
166 struct pti_masterchannel mccontrol
= {.master
= CONTROL_ID
,
168 const char *thread_name_p
;
169 const char *control_format
= "%3d %3d %s";
170 u8 control_frame
[CONTROL_FRAME_LEN
];
174 * Since we access the comm member in current's task_struct,
175 * we only need to be as large as what 'comm' in that
178 char comm
[TASK_COMM_LEN
];
181 get_task_comm(comm
, current
);
183 strncpy(comm
, "Interrupt", TASK_COMM_LEN
);
185 /* Absolutely ensure our buffer is zero terminated. */
186 comm
[TASK_COMM_LEN
-1] = 0;
187 thread_name_p
= comm
;
189 thread_name_p
= thread_name
;
192 mccontrol
.channel
= pti_control_channel
;
193 pti_control_channel
= (pti_control_channel
+ 1) & 0x7f;
195 snprintf(control_frame
, CONTROL_FRAME_LEN
, control_format
, mc
->master
,
196 mc
->channel
, thread_name_p
);
197 pti_write_to_aperture(&mccontrol
, control_frame
, strlen(control_frame
));
201 * pti_write_full_frame_to_aperture()- high level function to
204 * @mc: The 'aperture'. It's part of a write address that holds
205 * a master and channel ID.
206 * @buf: Data being written to the HW that will ultimately be seen
207 * in a debugging tool (Fido, Lauterbach).
208 * @len: Size of buffer.
210 * All threads sending data (either console, user space application, ...)
211 * are calling the high level function to write to PTI meaning that it is
212 * possible to add a control frame before sending the content.
214 static void pti_write_full_frame_to_aperture(struct pti_masterchannel
*mc
,
215 const unsigned char *buf
,
218 pti_control_frame_built_and_sent(mc
, NULL
);
219 pti_write_to_aperture(mc
, (u8
*)buf
, len
);
223 * get_id()- Allocate a master and channel ID.
225 * @id_array: an array of bits representing what channel
226 * id's are allocated for writing.
227 * @max_ids: The max amount of available write IDs to use.
228 * @base_id: The starting SW channel ID, based on the Intel
230 * @thread_name: The thread name associated with the master / channel or
231 * 'NULL' if using the 'current' global variable.
234 * pti_masterchannel struct with master, channel ID address
237 * Each bit in the arrays ia_app and ia_os correspond to a master and
238 * channel id. The bit is one if the id is taken and 0 if free. For
239 * every master there are 128 channel id's.
241 static struct pti_masterchannel
*get_id(u8
*id_array
,
244 const char *thread_name
)
246 struct pti_masterchannel
*mc
;
249 mc
= kmalloc(sizeof(struct pti_masterchannel
), GFP_KERNEL
);
253 /* look for a byte with a free bit */
254 for (i
= 0; i
< max_ids
; i
++)
255 if (id_array
[i
] != 0xff)
261 /* find the bit in the 128 possible channel opportunities */
263 for (j
= 0; j
< 8; j
++) {
264 if ((id_array
[i
] & mask
) == 0)
271 mc
->master
= base_id
;
272 mc
->channel
= ((i
& 0xf)<<3) + j
;
273 /* write new master Id / channel Id allocation to channel control */
274 pti_control_frame_built_and_sent(mc
, thread_name
);
279 * The following three functions:
280 * pti_request_mastercahannel(), mipi_release_masterchannel()
281 * and pti_writedata() are an API for other kernel drivers to
286 * pti_request_masterchannel()- Kernel API function used to allocate
287 * a master, channel ID address
288 * to write to PTI HW.
290 * @type: 0- request Application master, channel aperture ID
292 * 1- request OS master, channel aperture ID write
294 * 2- request Modem master, channel aperture ID
296 * Other values, error.
297 * @thread_name: The thread name associated with the master / channel or
298 * 'NULL' if using the 'current' global variable.
301 * pti_masterchannel struct
304 struct pti_masterchannel
*pti_request_masterchannel(u8 type
,
305 const char *thread_name
)
307 struct pti_masterchannel
*mc
;
309 mutex_lock(&alloclock
);
314 mc
= get_id(drv_data
->ia_app
, MAX_APP_IDS
,
315 APP_BASE_ID
, thread_name
);
319 mc
= get_id(drv_data
->ia_os
, MAX_OS_IDS
,
320 OS_BASE_ID
, thread_name
);
324 mc
= get_id(drv_data
->ia_modem
, MAX_MODEM_IDS
,
325 MODEM_BASE_ID
, thread_name
);
331 mutex_unlock(&alloclock
);
334 EXPORT_SYMBOL_GPL(pti_request_masterchannel
);
337 * pti_release_masterchannel()- Kernel API function used to release
338 * a master, channel ID address
339 * used to write to PTI HW.
341 * @mc: master, channel apeture ID address to be released. This
342 * will de-allocate the structure via kfree().
344 void pti_release_masterchannel(struct pti_masterchannel
*mc
)
346 u8 master
, channel
, i
;
348 mutex_lock(&alloclock
);
352 channel
= mc
->channel
;
354 if (master
== APP_BASE_ID
) {
356 drv_data
->ia_app
[i
] &= ~(0x80>>(channel
& 0x7));
357 } else if (master
== OS_BASE_ID
) {
359 drv_data
->ia_os
[i
] &= ~(0x80>>(channel
& 0x7));
362 drv_data
->ia_modem
[i
] &= ~(0x80>>(channel
& 0x7));
368 mutex_unlock(&alloclock
);
370 EXPORT_SYMBOL_GPL(pti_release_masterchannel
);
373 * pti_writedata()- Kernel API function used to write trace
374 * debugging data to PTI HW.
376 * @mc: Master, channel aperture ID address to write to.
377 * Null value will return with no write occurring.
378 * @buf: Trace debuging data to write to the PTI HW.
379 * Null value will return with no write occurring.
380 * @count: Size of buf. Value of 0 or a negative number will
381 * return with no write occuring.
383 void pti_writedata(struct pti_masterchannel
*mc
, u8
*buf
, int count
)
386 * since this function is exported, this is treated like an
387 * API function, thus, all parameters should
388 * be checked for validity.
390 if ((mc
!= NULL
) && (buf
!= NULL
) && (count
> 0))
391 pti_write_to_aperture(mc
, buf
, count
);
394 EXPORT_SYMBOL_GPL(pti_writedata
);
397 * pti_pci_remove()- Driver exit method to remove PTI from
399 * @pdev: variable containing pci info of PTI.
401 static void __devexit
pti_pci_remove(struct pci_dev
*pdev
)
403 struct pti_dev
*drv_data
;
405 drv_data
= pci_get_drvdata(pdev
);
406 if (drv_data
!= NULL
) {
407 pci_iounmap(pdev
, drv_data
->pti_ioaddr
);
408 pci_set_drvdata(pdev
, NULL
);
410 pci_release_region(pdev
, 1);
411 pci_disable_device(pdev
);
416 * for the tty_driver_*() basic function descriptions, see tty_driver.h.
417 * Specific header comments made for PTI-related specifics.
421 * pti_tty_driver_open()- Open an Application master, channel aperture
422 * ID to the PTI device via tty device.
424 * @tty: tty interface.
425 * @filp: filp interface pased to tty_port_open() call.
429 * otherwise, fail value
431 * The main purpose of using the tty device interface is for
432 * each tty port to have a unique PTI write aperture. In an
433 * example use case, ttyPTI0 gets syslogd and an APP aperture
434 * ID and ttyPTI1 is where the n_tracesink ldisc hooks to route
435 * modem messages into PTI. Modem trace data does not have to
436 * go to ttyPTI1, but ttyPTI0 and ttyPTI1 do need to be distinct
437 * master IDs. These messages go through the PTI HW and out of
438 * the handheld platform and to the Fido/Lauterbach device.
440 static int pti_tty_driver_open(struct tty_struct
*tty
, struct file
*filp
)
443 * we actually want to allocate a new channel per open, per
444 * system arch. HW gives more than plenty channels for a single
445 * system task to have its own channel to write trace data. This
446 * also removes a locking requirement for the actual write
449 return tty_port_open(&drv_data
->port
, tty
, filp
);
453 * pti_tty_driver_close()- close tty device and release Application
454 * master, channel aperture ID to the PTI device via tty device.
456 * @tty: tty interface.
457 * @filp: filp interface pased to tty_port_close() call.
459 * The main purpose of using the tty device interface is to route
460 * syslog daemon messages to the PTI HW and out of the handheld platform
461 * and to the Fido/Lauterbach device.
463 static void pti_tty_driver_close(struct tty_struct
*tty
, struct file
*filp
)
465 tty_port_close(&drv_data
->port
, tty
, filp
);
469 * pti_tty_install()- Used to set up specific master-channels
470 * to tty ports for organizational purposes when
471 * tracing viewed from debuging tools.
473 * @driver: tty driver information.
474 * @tty: tty struct containing pti information.
480 static int pti_tty_install(struct tty_driver
*driver
, struct tty_struct
*tty
)
482 int idx
= tty
->index
;
483 struct pti_tty
*pti_tty_data
;
484 int ret
= tty_init_termios(tty
);
487 tty_driver_kref_get(driver
);
489 driver
->ttys
[idx
] = tty
;
491 pti_tty_data
= kmalloc(sizeof(struct pti_tty
), GFP_KERNEL
);
492 if (pti_tty_data
== NULL
)
495 if (idx
== PTITTY_MINOR_START
)
496 pti_tty_data
->mc
= pti_request_masterchannel(0, NULL
);
498 pti_tty_data
->mc
= pti_request_masterchannel(2, NULL
);
500 if (pti_tty_data
->mc
== NULL
) {
504 tty
->driver_data
= pti_tty_data
;
511 * pti_tty_cleanup()- Used to de-allocate master-channel resources
512 * tied to tty's of this driver.
514 * @tty: tty struct containing pti information.
516 static void pti_tty_cleanup(struct tty_struct
*tty
)
518 struct pti_tty
*pti_tty_data
= tty
->driver_data
;
519 if (pti_tty_data
== NULL
)
521 pti_release_masterchannel(pti_tty_data
->mc
);
523 tty
->driver_data
= NULL
;
527 * pti_tty_driver_write()- Write trace debugging data through the char
528 * interface to the PTI HW. Part of the misc device implementation.
530 * @filp: Contains private data which is used to obtain
531 * master, channel write ID.
532 * @data: trace data to be written.
533 * @len: # of byte to write.
536 * int, # of bytes written
539 static int pti_tty_driver_write(struct tty_struct
*tty
,
540 const unsigned char *buf
, int len
)
542 struct pti_tty
*pti_tty_data
= tty
->driver_data
;
543 if ((pti_tty_data
!= NULL
) && (pti_tty_data
->mc
!= NULL
)) {
544 pti_write_to_aperture(pti_tty_data
->mc
, (u8
*)buf
, len
);
548 * we can't write to the pti hardware if the private driver_data
549 * and the mc address is not there.
556 * pti_tty_write_room()- Always returns 2048.
558 * @tty: contains tty info of the pti driver.
560 static int pti_tty_write_room(struct tty_struct
*tty
)
566 * pti_char_open()- Open an Application master, channel aperture
567 * ID to the PTI device. Part of the misc device implementation.
570 * @filp: Output- will have a masterchannel struct set containing
571 * the allocated application PTI aperture write address.
575 * otherwise, a fail value
577 static int pti_char_open(struct inode
*inode
, struct file
*filp
)
579 struct pti_masterchannel
*mc
;
582 * We really do want to fail immediately if
583 * pti_request_masterchannel() fails,
584 * before assigning the value to filp->private_data.
585 * Slightly easier to debug if this driver needs debugging.
587 mc
= pti_request_masterchannel(0, NULL
);
590 filp
->private_data
= mc
;
595 * pti_char_release()- Close a char channel to the PTI device. Part
596 * of the misc device implementation.
598 * @inode: Not used in this implementaiton.
599 * @filp: Contains private_data that contains the master, channel
600 * ID to be released by the PTI device.
605 static int pti_char_release(struct inode
*inode
, struct file
*filp
)
607 pti_release_masterchannel(filp
->private_data
);
608 filp
->private_data
= NULL
;
613 * pti_char_write()- Write trace debugging data through the char
614 * interface to the PTI HW. Part of the misc device implementation.
616 * @filp: Contains private data which is used to obtain
617 * master, channel write ID.
618 * @data: trace data to be written.
619 * @len: # of byte to write.
620 * @ppose: Not used in this function implementation.
623 * int, # of bytes written
624 * otherwise, error value
626 * Notes: From side discussions with Alan Cox and experimenting
627 * with PTI debug HW like Nokia's Fido box and Lauterbach
628 * devices, 8192 byte write buffer used by USER_COPY_SIZE was
629 * deemed an appropriate size for this type of usage with
632 static ssize_t
pti_char_write(struct file
*filp
, const char __user
*data
,
633 size_t len
, loff_t
*ppose
)
635 struct pti_masterchannel
*mc
;
637 const char __user
*tmp
;
638 size_t size
= USER_COPY_SIZE
;
642 mc
= filp
->private_data
;
644 kbuf
= kmalloc(size
, GFP_KERNEL
);
646 pr_err("%s(%d): buf allocation failed\n",
652 if (len
- n
> USER_COPY_SIZE
)
653 size
= USER_COPY_SIZE
;
657 if (copy_from_user(kbuf
, tmp
, size
)) {
659 return n
? n
: -EFAULT
;
662 pti_write_to_aperture(mc
, kbuf
, size
);
672 static const struct tty_operations pti_tty_driver_ops
= {
673 .open
= pti_tty_driver_open
,
674 .close
= pti_tty_driver_close
,
675 .write
= pti_tty_driver_write
,
676 .write_room
= pti_tty_write_room
,
677 .install
= pti_tty_install
,
678 .cleanup
= pti_tty_cleanup
681 static const struct file_operations pti_char_driver_ops
= {
682 .owner
= THIS_MODULE
,
683 .write
= pti_char_write
,
684 .open
= pti_char_open
,
685 .release
= pti_char_release
,
688 static struct miscdevice pti_char_driver
= {
689 .minor
= MISC_DYNAMIC_MINOR
,
691 .fops
= &pti_char_driver_ops
695 * pti_console_write()- Write to the console that has been acquired.
697 * @c: Not used in this implementaiton.
698 * @buf: Data to be written.
699 * @len: Length of buf.
701 static void pti_console_write(struct console
*c
, const char *buf
, unsigned len
)
703 static struct pti_masterchannel mc
= {.master
= CONSOLE_ID
,
706 mc
.channel
= pti_console_channel
;
707 pti_console_channel
= (pti_console_channel
+ 1) & 0x7f;
709 pti_write_full_frame_to_aperture(&mc
, buf
, len
);
713 * pti_console_device()- Return the driver tty structure and set the
714 * associated index implementation.
716 * @c: Console device of the driver.
717 * @index: index associated with c.
720 * always value of pti_tty_driver structure when this function
723 static struct tty_driver
*pti_console_device(struct console
*c
, int *index
)
726 return pti_tty_driver
;
730 * pti_console_setup()- Initialize console variables used by the driver.
738 static int pti_console_setup(struct console
*c
, char *opts
)
740 pti_console_channel
= 0;
741 pti_control_channel
= 0;
746 * pti_console struct, used to capture OS printk()'s and shift
747 * out to the PTI device for debugging. This cannot be
748 * enabled upon boot because of the possibility of eating
749 * any serial console printk's (race condition discovered).
750 * The console should be enabled upon when the tty port is
751 * used for the first time. Since the primary purpose for
752 * the tty port is to hook up syslog to it, the tty port
753 * will be open for a really long time.
755 static struct console pti_console
= {
757 .write
= pti_console_write
,
758 .device
= pti_console_device
,
759 .setup
= pti_console_setup
,
760 .flags
= CON_PRINTBUFFER
,
765 * pti_port_activate()- Used to start/initialize any items upon
766 * first opening of tty_port().
768 * @port- The tty port number of the PTI device.
769 * @tty- The tty struct associated with this device.
774 * Notes: The primary purpose of the PTI tty port 0 is to hook
775 * the syslog daemon to it; thus this port will be open for a
778 static int pti_port_activate(struct tty_port
*port
, struct tty_struct
*tty
)
780 if (port
->tty
->index
== PTITTY_MINOR_START
)
781 console_start(&pti_console
);
786 * pti_port_shutdown()- Used to stop/shutdown any items upon the
787 * last tty port close.
789 * @port- The tty port number of the PTI device.
791 * Notes: The primary purpose of the PTI tty port 0 is to hook
792 * the syslog daemon to it; thus this port will be open for a
795 static void pti_port_shutdown(struct tty_port
*port
)
797 if (port
->tty
->index
== PTITTY_MINOR_START
)
798 console_stop(&pti_console
);
801 static const struct tty_port_operations tty_port_ops
= {
802 .activate
= pti_port_activate
,
803 .shutdown
= pti_port_shutdown
,
807 * Note the _probe() call sets everything up and ties the char and tty
808 * to successfully detecting the PTI device on the pci bus.
812 * pti_pci_probe()- Used to detect pti on the pci bus and set
813 * things up in the driver.
815 * @pdev- pci_dev struct values for pti.
816 * @ent- pci_device_id struct for pti driver.
822 static int __devinit
pti_pci_probe(struct pci_dev
*pdev
,
823 const struct pci_device_id
*ent
)
825 int retval
= -EINVAL
;
828 dev_dbg(&pdev
->dev
, "%s %s(%d): PTI PCI ID %04x:%04x\n", __FILE__
,
829 __func__
, __LINE__
, pdev
->vendor
, pdev
->device
);
831 retval
= misc_register(&pti_char_driver
);
833 pr_err("%s(%d): CHAR registration failed of pti driver\n",
835 pr_err("%s(%d): Error value returned: %d\n",
836 __func__
, __LINE__
, retval
);
840 retval
= pci_enable_device(pdev
);
843 "%s: pci_enable_device() returned error %d\n",
848 drv_data
= kzalloc(sizeof(*drv_data
), GFP_KERNEL
);
850 if (drv_data
== NULL
) {
853 "%s(%d): kmalloc() returned NULL memory.\n",
857 drv_data
->pti_addr
= pci_resource_start(pdev
, pci_bar
);
859 retval
= pci_request_region(pdev
, pci_bar
, dev_name(&pdev
->dev
));
862 "%s(%d): pci_request_region() returned error %d\n",
863 __func__
, __LINE__
, retval
);
867 drv_data
->aperture_base
= drv_data
->pti_addr
+APERTURE_14
;
868 drv_data
->pti_ioaddr
=
869 ioremap_nocache((u32
)drv_data
->aperture_base
,
871 if (!drv_data
->pti_ioaddr
) {
872 pci_release_region(pdev
, pci_bar
);
878 pci_set_drvdata(pdev
, drv_data
);
880 tty_port_init(&drv_data
->port
);
881 drv_data
->port
.ops
= &tty_port_ops
;
883 tty_register_device(pti_tty_driver
, 0, &pdev
->dev
);
884 tty_register_device(pti_tty_driver
, 1, &pdev
->dev
);
886 register_console(&pti_console
);
891 static struct pci_driver pti_pci_driver
= {
894 .probe
= pti_pci_probe
,
895 .remove
= pti_pci_remove
,
900 * pti_init()- Overall entry/init call to the pti driver.
901 * It starts the registration process with the kernel.
904 * int __init, 0 for success
905 * otherwise value is an error
908 static int __init
pti_init(void)
910 int retval
= -EINVAL
;
912 /* First register module as tty device */
914 pti_tty_driver
= alloc_tty_driver(1);
915 if (pti_tty_driver
== NULL
) {
916 pr_err("%s(%d): Memory allocation failed for ptiTTY driver\n",
921 pti_tty_driver
->owner
= THIS_MODULE
;
922 pti_tty_driver
->magic
= TTY_DRIVER_MAGIC
;
923 pti_tty_driver
->driver_name
= DRIVERNAME
;
924 pti_tty_driver
->name
= TTYNAME
;
925 pti_tty_driver
->major
= 0;
926 pti_tty_driver
->minor_start
= PTITTY_MINOR_START
;
927 pti_tty_driver
->minor_num
= PTITTY_MINOR_NUM
;
928 pti_tty_driver
->num
= PTITTY_MINOR_NUM
;
929 pti_tty_driver
->type
= TTY_DRIVER_TYPE_SYSTEM
;
930 pti_tty_driver
->subtype
= SYSTEM_TYPE_SYSCONS
;
931 pti_tty_driver
->flags
= TTY_DRIVER_REAL_RAW
|
932 TTY_DRIVER_DYNAMIC_DEV
;
933 pti_tty_driver
->init_termios
= tty_std_termios
;
935 tty_set_operations(pti_tty_driver
, &pti_tty_driver_ops
);
937 retval
= tty_register_driver(pti_tty_driver
);
939 pr_err("%s(%d): TTY registration failed of pti driver\n",
941 pr_err("%s(%d): Error value returned: %d\n",
942 __func__
, __LINE__
, retval
);
944 pti_tty_driver
= NULL
;
948 retval
= pci_register_driver(&pti_pci_driver
);
951 pr_err("%s(%d): PCI registration failed of pti driver\n",
953 pr_err("%s(%d): Error value returned: %d\n",
954 __func__
, __LINE__
, retval
);
956 tty_unregister_driver(pti_tty_driver
);
957 pr_err("%s(%d): Unregistering TTY part of pti driver\n",
959 pti_tty_driver
= NULL
;
967 * pti_exit()- Unregisters this module as a tty and pci driver.
969 static void __exit
pti_exit(void)
973 tty_unregister_device(pti_tty_driver
, 0);
974 tty_unregister_device(pti_tty_driver
, 1);
976 retval
= tty_unregister_driver(pti_tty_driver
);
978 pr_err("%s(%d): TTY unregistration failed of pti driver\n",
980 pr_err("%s(%d): Error value returned: %d\n",
981 __func__
, __LINE__
, retval
);
984 pci_unregister_driver(&pti_pci_driver
);
986 retval
= misc_deregister(&pti_char_driver
);
988 pr_err("%s(%d): CHAR unregistration failed of pti driver\n",
990 pr_err("%s(%d): Error value returned: %d\n",
991 __func__
, __LINE__
, retval
);
994 unregister_console(&pti_console
);
998 module_init(pti_init
);
999 module_exit(pti_exit
);
1001 MODULE_LICENSE("GPL");
1002 MODULE_AUTHOR("Ken Mills, Jay Freyensee");
1003 MODULE_DESCRIPTION("PTI Driver");