1
2
3
4
5
6
7
8
9#include <linux/kernel.h>
10#include <linux/slab.h>
11#include <linux/input.h>
12#include <linux/module.h>
13#include <linux/spinlock.h>
14#include <linux/circ_buf.h>
15#include <linux/mutex.h>
16
17
18
19
20
21#include <linux/ioport.h>
22
23
24#define IFORCE_MAX_LENGTH 16
25
26#define IFORCE_EFFECTS_MAX 32
27
28
29
30
31#define FF_MOD1_IS_USED 0
32#define FF_MOD2_IS_USED 1
33#define FF_CORE_IS_USED 2
34#define FF_CORE_IS_PLAYED 3
35#define FF_CORE_SHOULD_PLAY 4
36#define FF_CORE_UPDATE 5
37#define FF_MODCORE_CNT 6
38
39struct iforce_core_effect {
40
41 struct resource mod1_chunk;
42 struct resource mod2_chunk;
43 unsigned long flags[BITS_TO_LONGS(FF_MODCORE_CNT)];
44};
45
46#define FF_CMD_EFFECT 0x010e
47#define FF_CMD_ENVELOPE 0x0208
48#define FF_CMD_MAGNITUDE 0x0303
49#define FF_CMD_PERIOD 0x0407
50#define FF_CMD_CONDITION 0x050a
51
52#define FF_CMD_AUTOCENTER 0x4002
53#define FF_CMD_PLAY 0x4103
54#define FF_CMD_ENABLE 0x4201
55#define FF_CMD_GAIN 0x4301
56
57#define FF_CMD_QUERY 0xff01
58
59
60#define XMIT_SIZE 256
61#define XMIT_INC(var, n) (var)+=n; (var)&= XMIT_SIZE -1
62
63#define IFORCE_XMIT_RUNNING 0
64#define IFORCE_XMIT_AGAIN 1
65
66struct iforce_device {
67 u16 idvendor;
68 u16 idproduct;
69 char *name;
70 signed short *btn;
71 signed short *abs;
72 signed short *ff;
73};
74
75struct iforce;
76
77struct iforce_xport_ops {
78 void (*xmit)(struct iforce *iforce);
79 int (*get_id)(struct iforce *iforce, u8 id,
80 u8 *response_data, size_t *response_len);
81 int (*start_io)(struct iforce *iforce);
82 void (*stop_io)(struct iforce *iforce);
83};
84
85struct iforce {
86 struct input_dev *dev;
87 struct iforce_device *type;
88 const struct iforce_xport_ops *xport_ops;
89
90 spinlock_t xmit_lock;
91
92 struct circ_buf xmit;
93 unsigned char xmit_data[XMIT_SIZE];
94 unsigned long xmit_flags[1];
95
96
97 wait_queue_head_t wait;
98 struct resource device_memory;
99 struct iforce_core_effect core_effects[IFORCE_EFFECTS_MAX];
100 struct mutex mem_mutex;
101};
102
103
104#define HI(a) ((unsigned char)((a) >> 8))
105#define LO(a) ((unsigned char)((a) & 0xff))
106
107
108
109
110#define HIFIX80(a) ((unsigned char)(((a)<0? (a)+255 : (a))>>8))
111
112
113#define TIME_SCALE(a) (a)
114
115static inline int iforce_get_id_packet(struct iforce *iforce, u8 id,
116 u8 *response_data, size_t *response_len)
117{
118 return iforce->xport_ops->get_id(iforce, id,
119 response_data, response_len);
120}
121
122
123
124int iforce_init_device(struct device *parent, u16 bustype,
125 struct iforce *iforce);
126
127
128int iforce_control_playback(struct iforce*, u16 id, unsigned int);
129void iforce_process_packet(struct iforce *iforce,
130 u8 packet_id, u8 *data, size_t len);
131int iforce_send_packet(struct iforce *iforce, u16 cmd, unsigned char* data);
132void iforce_dump_packet(struct iforce *iforce, char *msg, u16 cmd, unsigned char *data);
133
134
135int iforce_upload_periodic(struct iforce *, struct ff_effect *, struct ff_effect *);
136int iforce_upload_constant(struct iforce *, struct ff_effect *, struct ff_effect *);
137int iforce_upload_condition(struct iforce *, struct ff_effect *, struct ff_effect *);
138
139
140extern struct serio_driver iforce_serio_drv;
141extern struct usb_driver iforce_usb_driver;
142