1
2
3
4
5
6
7
8
9
10
11#include <linux/kernel.h>
12#include <linux/errno.h>
13#include <linux/init.h>
14#include <linux/slab.h>
15#include <linux/tty.h>
16#include <linux/module.h>
17#include <linux/usb.h>
18#include <linux/usb/serial.h>
19
20
21#define CPUCS_REG 0x7F92
22
23int ezusb_writememory (struct usb_serial *serial, int address, unsigned char *data, int length, __u8 bRequest)
24{
25 int result;
26 unsigned char *transfer_buffer;
27
28
29 if (!serial->dev) {
30 err("%s - no physical device present, failing.", __FUNCTION__);
31 return -ENODEV;
32 }
33
34 transfer_buffer = kmemdup(data, length, GFP_KERNEL);
35 if (!transfer_buffer) {
36 dev_err(&serial->dev->dev, "%s - kmalloc(%d) failed.\n", __FUNCTION__, length);
37 return -ENOMEM;
38 }
39 result = usb_control_msg (serial->dev, usb_sndctrlpipe(serial->dev, 0), bRequest, 0x40, address, 0, transfer_buffer, length, 3000);
40 kfree (transfer_buffer);
41 return result;
42}
43
44int ezusb_set_reset (struct usb_serial *serial, unsigned char reset_bit)
45{
46 int response;
47
48
49 response = ezusb_writememory (serial, CPUCS_REG, &reset_bit, 1, 0xa0);
50 if (response < 0)
51 dev_err(&serial->dev->dev, "%s- %d failed\n", __FUNCTION__, reset_bit);
52 return response;
53}
54
55
56EXPORT_SYMBOL(ezusb_writememory);
57EXPORT_SYMBOL(ezusb_set_reset);
58
59