Commit | Line | Data |
---|---|---|
355b4b2b | 1 | /* cypress_firmware.c is part of the DVB USB library. |
b00a9018 AP |
2 | * |
3 | * Copyright (C) 2004-6 Patrick Boettcher (patrick.boettcher@desy.de) | |
4 | * see dvb-usb-init.c for copyright information. | |
5 | * | |
6 | * This file contains functions for downloading the firmware to Cypress FX 1 | |
7 | * and 2 based devices. | |
8 | * | |
9 | */ | |
10 | ||
79a63c60 HV |
11 | #include <linux/module.h> |
12 | #include <linux/slab.h> | |
13 | #include <linux/usb.h> | |
14 | #include <linux/firmware.h> | |
355b4b2b | 15 | #include "cypress_firmware.h" |
b00a9018 AP |
16 | |
17 | struct usb_cypress_controller { | |
18 | u8 id; | |
19 | const char *name; /* name of the usb controller */ | |
20 | u16 cs_reg; /* needs to be restarted, | |
21 | * when the firmware has been downloaded */ | |
22 | }; | |
23 | ||
24 | static const struct usb_cypress_controller cypress[] = { | |
25 | { .id = CYPRESS_AN2135, .name = "Cypress AN2135", .cs_reg = 0x7f92 }, | |
26 | { .id = CYPRESS_AN2235, .name = "Cypress AN2235", .cs_reg = 0x7f92 }, | |
27 | { .id = CYPRESS_FX2, .name = "Cypress FX2", .cs_reg = 0xe600 }, | |
28 | }; | |
29 | ||
30 | /* | |
31 | * load a firmware packet to the device | |
32 | */ | |
33 | static int usb_cypress_writemem(struct usb_device *udev, u16 addr, u8 *data, | |
34 | u8 len) | |
35 | { | |
36 | return usb_control_msg(udev, usb_sndctrlpipe(udev, 0), | |
37 | 0xa0, USB_TYPE_VENDOR, addr, 0x00, data, len, 5000); | |
38 | } | |
39 | ||
79a63c60 HV |
40 | static int cypress_get_hexline(const struct firmware *fw, |
41 | struct hexline *hx, int *pos) | |
42 | { | |
43 | u8 *b = (u8 *) &fw->data[*pos]; | |
44 | int data_offs = 4; | |
45 | ||
46 | if (*pos >= fw->size) | |
47 | return 0; | |
48 | ||
49 | memset(hx, 0, sizeof(struct hexline)); | |
50 | hx->len = b[0]; | |
51 | ||
52 | if ((*pos + hx->len + 4) >= fw->size) | |
53 | return -EINVAL; | |
54 | ||
55 | hx->addr = b[1] | (b[2] << 8); | |
56 | hx->type = b[3]; | |
57 | ||
58 | if (hx->type == 0x04) { | |
59 | /* b[4] and b[5] are the Extended linear address record data | |
60 | * field */ | |
61 | hx->addr |= (b[4] << 24) | (b[5] << 16); | |
62 | } | |
63 | ||
64 | memcpy(hx->data, &b[data_offs], hx->len); | |
65 | hx->chk = b[hx->len + data_offs]; | |
66 | *pos += hx->len + 5; | |
67 | ||
68 | return *pos; | |
69 | } | |
70 | ||
71 | int cypress_load_firmware(struct usb_device *udev, | |
b00a9018 AP |
72 | const struct firmware *fw, int type) |
73 | { | |
2347e683 | 74 | struct hexline *hx; |
b00a9018 AP |
75 | int ret, pos = 0; |
76 | ||
2347e683 AP |
77 | hx = kmalloc(sizeof(struct hexline), GFP_KERNEL); |
78 | if (!hx) { | |
79 | dev_err(&udev->dev, "%s: kmalloc() failed\n", KBUILD_MODNAME); | |
80 | return -ENOMEM; | |
81 | } | |
82 | ||
b00a9018 | 83 | /* stop the CPU */ |
2347e683 AP |
84 | hx->data[0] = 1; |
85 | ret = usb_cypress_writemem(udev, cypress[type].cs_reg, hx->data, 1); | |
86 | if (ret != 1) { | |
87 | dev_err(&udev->dev, "%s: CPU stop failed=%d\n", | |
88 | KBUILD_MODNAME, ret); | |
89 | ret = -EIO; | |
90 | goto err_kfree; | |
91 | } | |
92 | ||
93 | /* write firmware to memory */ | |
94 | for (;;) { | |
79a63c60 | 95 | ret = cypress_get_hexline(fw, hx, &pos); |
2347e683 AP |
96 | if (ret < 0) |
97 | goto err_kfree; | |
98 | else if (ret == 0) | |
99 | break; | |
100 | ||
101 | ret = usb_cypress_writemem(udev, hx->addr, hx->data, hx->len); | |
102 | if (ret < 0) { | |
103 | goto err_kfree; | |
104 | } else if (ret != hx->len) { | |
61356eea AP |
105 | dev_err(&udev->dev, |
106 | "%s: error while transferring firmware (transferred size=%d, block size=%d)\n", | |
2347e683 AP |
107 | KBUILD_MODNAME, ret, hx->len); |
108 | ret = -EIO; | |
109 | goto err_kfree; | |
b00a9018 AP |
110 | } |
111 | } | |
b00a9018 | 112 | |
2347e683 AP |
113 | /* start the CPU */ |
114 | hx->data[0] = 0; | |
115 | ret = usb_cypress_writemem(udev, cypress[type].cs_reg, hx->data, 1); | |
116 | if (ret != 1) { | |
117 | dev_err(&udev->dev, "%s: CPU start failed=%d\n", | |
118 | KBUILD_MODNAME, ret); | |
b00a9018 | 119 | ret = -EIO; |
2347e683 AP |
120 | goto err_kfree; |
121 | } | |
b00a9018 | 122 | |
2347e683 AP |
123 | ret = 0; |
124 | err_kfree: | |
125 | kfree(hx); | |
b00a9018 AP |
126 | return ret; |
127 | } | |
79a63c60 | 128 | EXPORT_SYMBOL(cypress_load_firmware); |
b00a9018 AP |
129 | |
130 | MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>"); | |
131 | MODULE_DESCRIPTION("Cypress firmware download"); | |
132 | MODULE_LICENSE("GPL"); |