1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
|
/* Copyright (c) 2009, The Linux Foundation. All rights reserved.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License version 2 and
* only version 2 as published by the Free Software Foundation.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
*/
/*
* PROC COMM TEST Driver source file
*/
#include <linux/types.h>
#include <linux/uaccess.h>
#include <linux/debugfs.h>
#include <linux/module.h>
#include <mach/proc_comm.h>
static struct dentry *dent;
static int proc_comm_test_res;
static int proc_comm_reverse_test(void)
{
uint32_t data1, data2;
int rc;
data1 = 10;
data2 = 20;
rc = msm_proc_comm(PCOM_OEM_TEST_CMD, &data1, &data2);
if (rc)
return rc;
if ((data1 != 20) || (data2 != 10))
return -1;
return 0;
}
static ssize_t debug_read(struct file *fp, char __user *buf,
size_t count, loff_t *pos)
{
char _buf[16];
snprintf(_buf, sizeof(_buf), "%i\n", proc_comm_test_res);
return simple_read_from_buffer(buf, count, pos, _buf, strlen(_buf));
}
static ssize_t debug_write(struct file *fp, const char __user *buf,
size_t count, loff_t *pos)
{
unsigned char cmd[64];
int len;
if (count < 1)
return 0;
len = count > 63 ? 63 : count;
if (copy_from_user(cmd, buf, len))
return -EFAULT;
cmd[len] = 0;
if (cmd[len-1] == '\n') {
cmd[len-1] = 0;
len--;
}
if (!strncmp(cmd, "reverse_test", 64))
proc_comm_test_res = proc_comm_reverse_test();
else
proc_comm_test_res = -EINVAL;
if (proc_comm_test_res)
pr_err("proc comm test fail %d\n",
proc_comm_test_res);
else
pr_info("proc comm test passed\n");
return count;
}
static int debug_release(struct inode *ip, struct file *fp)
{
return 0;
}
static int debug_open(struct inode *ip, struct file *fp)
{
return 0;
}
static const struct file_operations debug_ops = {
.owner = THIS_MODULE,
.open = debug_open,
.release = debug_release,
.read = debug_read,
.write = debug_write,
};
static void __exit proc_comm_test_mod_exit(void)
{
debugfs_remove(dent);
}
static int __init proc_comm_test_mod_init(void)
{
dent = debugfs_create_file("proc_comm", 0444, 0, NULL, &debug_ops);
proc_comm_test_res = -1;
return 0;
}
module_init(proc_comm_test_mod_init);
module_exit(proc_comm_test_mod_exit);
MODULE_DESCRIPTION("PROC COMM TEST Driver");
MODULE_LICENSE("GPL v2");
|
