librtlsdr.c 31 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390
  1. /*
  2. * rtl-sdr, turns your Realtek RTL2832 based DVB dongle into a SDR receiver
  3. * Copyright (C) 2012 by Steve Markgraf <steve@steve-m.de>
  4. * Copyright (C) 2012 by Dimitri Stolnikov <horiz0n@gmx.net>
  5. *
  6. * This program is free software: you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License as published by
  8. * the Free Software Foundation, either version 2 of the License, or
  9. * (at your option) any later version.
  10. *
  11. * This program is distributed in the hope that it will be useful,
  12. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  14. * GNU General Public License for more details.
  15. *
  16. * You should have received a copy of the GNU General Public License
  17. * along with this program. If not, see <http://www.gnu.org/licenses/>.
  18. */
  19. #include <errno.h>
  20. #include <signal.h>
  21. #include <string.h>
  22. #include <stdio.h>
  23. #include <stdlib.h>
  24. #ifndef _WIN32
  25. #include <unistd.h>
  26. #define min(a, b) (((a) < (b)) ? (a) : (b))
  27. #endif
  28. #include <libusb.h>
  29. /*
  30. * All libusb callback functions should be marked with the LIBUSB_CALL macro
  31. * to ensure that they are compiled with the same calling convention as libusb.
  32. *
  33. * If the macro isn't available in older libusb versions, we simply define it.
  34. */
  35. #ifndef LIBUSB_CALL
  36. #define LIBUSB_CALL
  37. #endif
  38. #include "rtl-sdr.h"
  39. #include "tuner_e4k.h"
  40. #include "tuner_fc0012.h"
  41. #include "tuner_fc0013.h"
  42. #include "tuner_fc2580.h"
  43. typedef struct rtlsdr_tuner_iface {
  44. /* tuner interface */
  45. int (*init)(void *);
  46. int (*exit)(void *);
  47. int (*set_freq)(void *, uint32_t freq /* Hz */);
  48. int (*set_bw)(void *, int bw /* Hz */);
  49. int (*set_gain)(void *, int gain /* tenth dB */);
  50. int (*set_if_gain)(void *, int stage, int gain /* tenth dB */);
  51. int (*set_gain_mode)(void *, int manual);
  52. } rtlsdr_tuner_iface_t;
  53. enum rtlsdr_async_status {
  54. RTLSDR_INACTIVE = 0,
  55. RTLSDR_CANCELING,
  56. RTLSDR_RUNNING
  57. };
  58. struct rtlsdr_dev {
  59. libusb_context *ctx;
  60. struct libusb_device_handle *devh;
  61. uint32_t xfer_buf_num;
  62. uint32_t xfer_buf_len;
  63. struct libusb_transfer **xfer;
  64. unsigned char **xfer_buf;
  65. rtlsdr_read_async_cb_t cb;
  66. void *cb_ctx;
  67. enum rtlsdr_async_status async_status;
  68. /* rtl demod context */
  69. uint32_t rate; /* Hz */
  70. uint32_t rtl_xtal; /* Hz */
  71. /* tuner context */
  72. enum rtlsdr_tuner tuner_type;
  73. rtlsdr_tuner_iface_t *tuner;
  74. uint32_t tun_xtal; /* Hz */
  75. uint32_t freq; /* Hz */
  76. int corr; /* ppm */
  77. int gain; /* tenth dB */
  78. struct e4k_state e4k_s;
  79. };
  80. void rtlsdr_set_gpio_bit(rtlsdr_dev_t *dev, uint8_t gpio, int val);
  81. /* generic tuner interface functions, shall be moved to the tuner implementations */
  82. int e4000_init(void *dev) {
  83. rtlsdr_dev_t* devt = (rtlsdr_dev_t*)dev;
  84. devt->e4k_s.i2c_addr = E4K_I2C_ADDR;
  85. devt->e4k_s.vco.fosc = devt->tun_xtal; /* no need to correct it here */
  86. devt->e4k_s.rtl_dev = dev;
  87. return e4k_init(&devt->e4k_s);
  88. }
  89. int e4000_exit(void *dev) { return 0; }
  90. int e4000_set_freq(void *dev, uint32_t freq) {
  91. rtlsdr_dev_t* devt = (rtlsdr_dev_t*)dev;
  92. return e4k_tune_freq(&devt->e4k_s, freq);
  93. }
  94. int e4000_set_bw(void *dev, int bw) {
  95. return 0;
  96. }
  97. int e4000_set_gain(void *dev, int gain) {
  98. rtlsdr_dev_t* devt = (rtlsdr_dev_t*)dev;
  99. int mixgain = (gain > 340) ? 12 : 4;
  100. #if 0
  101. int enhgain = (gain - 420);
  102. #endif
  103. if(e4k_set_lna_gain(&devt->e4k_s, min(300, gain - mixgain * 10)) == -EINVAL)
  104. return -1;
  105. if(e4k_mixer_gain_set(&devt->e4k_s, mixgain) == -EINVAL)
  106. return -1;
  107. #if 0 /* enhanced mixer gain seems to have no effect */
  108. if(enhgain >= 0)
  109. if(e4k_set_enh_gain(&devt->e4k_s, enhgain) == -EINVAL)
  110. return -1;
  111. #endif
  112. return 0;
  113. }
  114. int e4000_set_if_gain(void *dev, int stage, int gain) {
  115. rtlsdr_dev_t* devt = (rtlsdr_dev_t*)dev;
  116. return e4k_if_gain_set(&devt->e4k_s, (uint8_t)stage, (int8_t)(gain / 10));
  117. }
  118. int e4000_set_gain_mode(void *dev, int manual) {
  119. rtlsdr_dev_t* devt = (rtlsdr_dev_t*)dev;
  120. return e4k_enable_manual_gain(&devt->e4k_s, manual);
  121. }
  122. int _fc0012_init(void *dev) { return fc0012_init(dev); }
  123. int fc0012_exit(void *dev) { return 0; }
  124. int fc0012_set_freq(void *dev, uint32_t freq) {
  125. /* select V-band/U-band filter */
  126. rtlsdr_set_gpio_bit(dev, 6, (freq > 300000000) ? 1 : 0);
  127. return fc0012_set_params(dev, freq, 6000000);
  128. }
  129. int fc0012_set_bw(void *dev, int bw) { return 0; }
  130. int _fc0012_set_gain(void *dev, int gain) { return fc0012_set_gain(dev, gain); }
  131. int fc0012_set_gain_mode(void *dev, int manual) { return 0; }
  132. int _fc0013_init(void *dev) { return fc0013_init(dev); }
  133. int fc0013_exit(void *dev) { return 0; }
  134. int fc0013_set_freq(void *dev, uint32_t freq) {
  135. /* select V-band/U-band filter */
  136. rtlsdr_set_gpio_bit(dev, 6, (freq > 300000000) ? 1 : 0);
  137. return fc0013_set_params(dev, freq, 6000000);
  138. }
  139. int fc0013_set_bw(void *dev, int bw) { return 0; }
  140. int _fc0013_set_gain(void *dev, int gain) { return fc0013_set_gain(dev, gain); }
  141. int fc0013_set_gain_mode(void *dev, int manual) { return 0; }
  142. int fc2580_init(void *dev) { return fc2580_Initialize(dev); }
  143. int fc2580_exit(void *dev) { return 0; }
  144. int _fc2580_set_freq(void *dev, uint32_t freq) {
  145. return fc2580_SetRfFreqHz(dev, freq);
  146. }
  147. int fc2580_set_bw(void *dev, int bw) { return fc2580_SetBandwidthMode(dev, 1); }
  148. int fc2580_set_gain(void *dev, int gain) { return 0; }
  149. int fc2580_set_gain_mode(void *dev, int manual) { return 0; }
  150. /* definition order must match enum rtlsdr_tuner */
  151. static rtlsdr_tuner_iface_t tuners[] = {
  152. {
  153. NULL, NULL, NULL, NULL, NULL, NULL, NULL /* dummy for unknown tuners */
  154. },
  155. {
  156. e4000_init, e4000_exit,
  157. e4000_set_freq, e4000_set_bw, e4000_set_gain, e4000_set_if_gain,
  158. e4000_set_gain_mode
  159. },
  160. {
  161. _fc0012_init, fc0012_exit,
  162. fc0012_set_freq, fc0012_set_bw, _fc0012_set_gain, NULL,
  163. fc0012_set_gain_mode
  164. },
  165. {
  166. _fc0013_init, fc0013_exit,
  167. fc0013_set_freq, fc0013_set_bw, _fc0013_set_gain, NULL,
  168. fc0013_set_gain_mode
  169. },
  170. {
  171. fc2580_init, fc2580_exit,
  172. _fc2580_set_freq, fc2580_set_bw, fc2580_set_gain, NULL,
  173. fc2580_set_gain_mode
  174. },
  175. };
  176. typedef struct rtlsdr_dongle {
  177. uint16_t vid;
  178. uint16_t pid;
  179. const char *name;
  180. } rtlsdr_dongle_t;
  181. /*
  182. * Please add your device here and send a patch to osmocom-sdr@lists.osmocom.org
  183. */
  184. static rtlsdr_dongle_t known_devices[] = {
  185. { 0x0bda, 0x2832, "Generic RTL2832U (e.g. hama nano)" },
  186. { 0x0bda, 0x2838, "ezcap USB 2.0 DVB-T/DAB/FM dongle" },
  187. { 0x0ccd, 0x00a9, "Terratec Cinergy T Stick Black (rev 1)" },
  188. { 0x0ccd, 0x00b3, "Terratec NOXON DAB/DAB+ USB dongle (rev 1)" },
  189. { 0x0ccd, 0x00b4, "Terratec NOXON DAB/DAB+ USB dongle (rev 1)" },
  190. { 0x0ccd, 0x00b7, "Terratec NOXON DAB/DAB+ USB dongle (rev 1)" },
  191. { 0x0ccd, 0x00c6, "Terratec NOXON DAB/DAB+ USB dongle (rev 1)" },
  192. { 0x0ccd, 0x00d3, "Terratec Cinergy T Stick RC (Rev.3)" },
  193. { 0x0ccd, 0x00d7, "Terratec T Stick PLUS" },
  194. { 0x0ccd, 0x00e0, "Terratec NOXON DAB/DAB+ USB dongle (rev 2)" },
  195. { 0x185b, 0x0620, "Compro Videomate U620F"},
  196. { 0x185b, 0x0650, "Compro Videomate U650F"},
  197. { 0x185b, 0x0680, "Compro Videomate U680F"},
  198. { 0x1f4d, 0xb803, "GTek T803" },
  199. { 0x1f4d, 0xc803, "Lifeview LV5TDeluxe" },
  200. { 0x1f4d, 0xd286, "MyGica TD312" },
  201. { 0x1f4d, 0xd803, "PROlectrix DV107669" },
  202. { 0x1b80, 0xd398, "Zaapa ZT-MINDVBZP" },
  203. { 0x1b80, 0xd3a4, "Twintech UT-40" },
  204. { 0x1d19, 0x1101, "Dexatek DK DVB-T Dongle (Logilink VG0002A)" },
  205. { 0x1d19, 0x1102, "Dexatek DK DVB-T Dongle (MSI DigiVox mini II V3.0)" },
  206. { 0x1d19, 0x1103, "Dexatek Technology Ltd. DK 5217 DVB-T Dongle" },
  207. { 0x0458, 0x707f, "Genius TVGo DVB-T03 USB dongle (Ver. B)" },
  208. { 0x1b80, 0xd393, "GIGABYTE GT-U7300" },
  209. { 0x1b80, 0xd394, "DIKOM USB-DVBT HD" },
  210. { 0x1b80, 0xd395, "Peak 102569AGPK" },
  211. { 0x1b80, 0xd39d, "SVEON STV20 DVB-T USB & FM" },
  212. };
  213. #define DEFAULT_BUF_NUMBER 32
  214. #define DEFAULT_BUF_LENGTH (16 * 32 * 512)
  215. #define DEF_RTL_XTAL_FREQ 28800000
  216. #define MIN_RTL_XTAL_FREQ (DEF_RTL_XTAL_FREQ - 1000)
  217. #define MAX_RTL_XTAL_FREQ (DEF_RTL_XTAL_FREQ + 1000)
  218. #define MAX_SAMP_RATE 3200000
  219. #define CTRL_IN (LIBUSB_REQUEST_TYPE_VENDOR | LIBUSB_ENDPOINT_IN)
  220. #define CTRL_OUT (LIBUSB_REQUEST_TYPE_VENDOR | LIBUSB_ENDPOINT_OUT)
  221. #define CTRL_TIMEOUT 300
  222. #define BULK_TIMEOUT 0
  223. enum usb_reg {
  224. USB_SYSCTL = 0x2000,
  225. USB_CTRL = 0x2010,
  226. USB_STAT = 0x2014,
  227. USB_EPA_CFG = 0x2144,
  228. USB_EPA_CTL = 0x2148,
  229. USB_EPA_MAXPKT = 0x2158,
  230. USB_EPA_MAXPKT_2 = 0x215a,
  231. USB_EPA_FIFO_CFG = 0x2160,
  232. };
  233. enum sys_reg {
  234. DEMOD_CTL = 0x3000,
  235. GPO = 0x3001,
  236. GPI = 0x3002,
  237. GPOE = 0x3003,
  238. GPD = 0x3004,
  239. SYSINTE = 0x3005,
  240. SYSINTS = 0x3006,
  241. GP_CFG0 = 0x3007,
  242. GP_CFG1 = 0x3008,
  243. SYSINTE_1 = 0x3009,
  244. SYSINTS_1 = 0x300a,
  245. DEMOD_CTL_1 = 0x300b,
  246. IR_SUSPEND = 0x300c,
  247. };
  248. enum blocks {
  249. DEMODB = 0,
  250. USBB = 1,
  251. SYSB = 2,
  252. TUNB = 3,
  253. ROMB = 4,
  254. IRB = 5,
  255. IICB = 6,
  256. };
  257. int rtlsdr_read_array(rtlsdr_dev_t *dev, uint8_t block, uint16_t addr, uint8_t *array, uint8_t len)
  258. {
  259. int r;
  260. uint16_t index = (block << 8);
  261. r = libusb_control_transfer(dev->devh, CTRL_IN, 0, addr, index, array, len, CTRL_TIMEOUT);
  262. #if 0
  263. if (r < 0)
  264. fprintf(stderr, "%s failed with %d\n", __FUNCTION__, r);
  265. #endif
  266. return r;
  267. }
  268. int rtlsdr_write_array(rtlsdr_dev_t *dev, uint8_t block, uint16_t addr, uint8_t *array, uint8_t len)
  269. {
  270. int r;
  271. uint16_t index = (block << 8) | 0x10;
  272. r = libusb_control_transfer(dev->devh, CTRL_OUT, 0, addr, index, array, len, CTRL_TIMEOUT);
  273. #if 0
  274. if (r < 0)
  275. fprintf(stderr, "%s failed with %d\n", __FUNCTION__, r);
  276. #endif
  277. return r;
  278. }
  279. int rtlsdr_i2c_write_reg(rtlsdr_dev_t *dev, uint8_t i2c_addr, uint8_t reg, uint8_t val)
  280. {
  281. uint16_t addr = i2c_addr;
  282. uint8_t data[2];
  283. data[0] = reg;
  284. data[1] = val;
  285. return rtlsdr_write_array(dev, IICB, addr, (uint8_t *)&data, 2);
  286. }
  287. uint8_t rtlsdr_i2c_read_reg(rtlsdr_dev_t *dev, uint8_t i2c_addr, uint8_t reg)
  288. {
  289. uint16_t addr = i2c_addr;
  290. uint8_t data = 0;
  291. rtlsdr_write_array(dev, IICB, addr, &reg, 1);
  292. rtlsdr_read_array(dev, IICB, addr, &data, 1);
  293. return data;
  294. }
  295. /* TODO clean this up again */
  296. int e4k_reg_write(struct e4k_state *e4k, uint8_t reg, uint8_t val)
  297. {
  298. return rtlsdr_i2c_write_reg((rtlsdr_dev_t*)e4k->rtl_dev, e4k->i2c_addr, reg, val);}
  299. uint8_t e4k_reg_read(struct e4k_state *e4k, uint8_t reg)
  300. {
  301. return rtlsdr_i2c_read_reg((rtlsdr_dev_t*)e4k->rtl_dev, e4k->i2c_addr, reg);
  302. }
  303. int rtlsdr_i2c_write(rtlsdr_dev_t *dev, uint8_t i2c_addr, uint8_t *buffer, int len)
  304. {
  305. uint16_t addr = i2c_addr;
  306. if (!dev)
  307. return -1;
  308. return rtlsdr_write_array(dev, IICB, addr, buffer, len);
  309. }
  310. int rtlsdr_i2c_read(rtlsdr_dev_t *dev, uint8_t i2c_addr, uint8_t *buffer, int len)
  311. {
  312. uint16_t addr = i2c_addr;
  313. if (!dev)
  314. return -1;
  315. return rtlsdr_read_array(dev, IICB, addr, buffer, len);
  316. }
  317. uint16_t rtlsdr_read_reg(rtlsdr_dev_t *dev, uint8_t block, uint16_t addr, uint8_t len)
  318. {
  319. int r;
  320. unsigned char data[2];
  321. uint16_t index = (block << 8);
  322. uint16_t reg;
  323. r = libusb_control_transfer(dev->devh, CTRL_IN, 0, addr, index, data, len, CTRL_TIMEOUT);
  324. if (r < 0)
  325. fprintf(stderr, "%s failed with %d\n", __FUNCTION__, r);
  326. reg = (data[1] << 8) | data[0];
  327. return reg;
  328. }
  329. int rtlsdr_write_reg(rtlsdr_dev_t *dev, uint8_t block, uint16_t addr, uint16_t val, uint8_t len)
  330. {
  331. int r;
  332. unsigned char data[2];
  333. uint16_t index = (block << 8) | 0x10;
  334. if (len == 1)
  335. data[0] = val & 0xff;
  336. else
  337. data[0] = val >> 8;
  338. data[1] = val & 0xff;
  339. r = libusb_control_transfer(dev->devh, CTRL_OUT, 0, addr, index, data, len, CTRL_TIMEOUT);
  340. if (r < 0)
  341. fprintf(stderr, "%s failed with %d\n", __FUNCTION__, r);
  342. return r;
  343. }
  344. uint16_t rtlsdr_demod_read_reg(rtlsdr_dev_t *dev, uint8_t page, uint16_t addr, uint8_t len)
  345. {
  346. int r;
  347. unsigned char data[2];
  348. uint16_t index = page;
  349. uint16_t reg;
  350. addr = (addr << 8) | 0x20;
  351. r = libusb_control_transfer(dev->devh, CTRL_IN, 0, addr, index, data, len, CTRL_TIMEOUT);
  352. if (r < 0)
  353. fprintf(stderr, "%s failed with %d\n", __FUNCTION__, r);
  354. reg = (data[1] << 8) | data[0];
  355. return reg;
  356. }
  357. int rtlsdr_demod_write_reg(rtlsdr_dev_t *dev, uint8_t page, uint16_t addr, uint16_t val, uint8_t len)
  358. {
  359. int r;
  360. unsigned char data[2];
  361. uint16_t index = 0x10 | page;
  362. addr = (addr << 8) | 0x20;
  363. if (len == 1)
  364. data[0] = val & 0xff;
  365. else
  366. data[0] = val >> 8;
  367. data[1] = val & 0xff;
  368. r = libusb_control_transfer(dev->devh, CTRL_OUT, 0, addr, index, data, len, CTRL_TIMEOUT);
  369. if (r < 0)
  370. fprintf(stderr, "%s failed with %d\n", __FUNCTION__, r);
  371. rtlsdr_demod_read_reg(dev, 0x0a, 0x01, 1);
  372. return r;
  373. }
  374. void rtlsdr_set_gpio_bit(rtlsdr_dev_t *dev, uint8_t gpio, int val)
  375. {
  376. uint8_t r;
  377. gpio = 1 << gpio;
  378. r = rtlsdr_read_reg(dev, SYSB, GPO, 1);
  379. r = val ? (r | gpio) : (r & ~gpio);
  380. rtlsdr_write_reg(dev, SYSB, GPO, r, 1);
  381. }
  382. void rtlsdr_set_gpio_output(rtlsdr_dev_t *dev, uint8_t gpio)
  383. {
  384. int r;
  385. gpio = 1 << gpio;
  386. r = rtlsdr_read_reg(dev, SYSB, GPD, 1);
  387. rtlsdr_write_reg(dev, SYSB, GPO, r & ~gpio, 1);
  388. r = rtlsdr_read_reg(dev, SYSB, GPOE, 1);
  389. rtlsdr_write_reg(dev, SYSB, GPOE, r | gpio, 1);
  390. }
  391. void rtlsdr_set_i2c_repeater(rtlsdr_dev_t *dev, int on)
  392. {
  393. rtlsdr_demod_write_reg(dev, 1, 0x01, on ? 0x18 : 0x10, 1);
  394. }
  395. void rtlsdr_init_baseband(rtlsdr_dev_t *dev)
  396. {
  397. unsigned int i;
  398. /* default FIR coefficients used for DAB/FM by the Windows driver,
  399. * the DVB driver uses different ones */
  400. uint8_t fir_coeff[] = {
  401. 0xca, 0xdc, 0xd7, 0xd8, 0xe0, 0xf2, 0x0e, 0x35, 0x06, 0x50,
  402. 0x9c, 0x0d, 0x71, 0x11, 0x14, 0x71, 0x74, 0x19, 0x41, 0xa5,
  403. };
  404. /* initialize USB */
  405. rtlsdr_write_reg(dev, USBB, USB_SYSCTL, 0x09, 1);
  406. rtlsdr_write_reg(dev, USBB, USB_EPA_MAXPKT, 0x0002, 2);
  407. rtlsdr_write_reg(dev, USBB, USB_EPA_CTL, 0x1002, 2);
  408. /* poweron demod */
  409. rtlsdr_write_reg(dev, SYSB, DEMOD_CTL_1, 0x22, 1);
  410. rtlsdr_write_reg(dev, SYSB, DEMOD_CTL, 0xe8, 1);
  411. /* reset demod (bit 3, soft_rst) */
  412. rtlsdr_demod_write_reg(dev, 1, 0x01, 0x14, 1);
  413. rtlsdr_demod_write_reg(dev, 1, 0x01, 0x10, 1);
  414. /* disable spectrum inversion and adjacent channel rejection */
  415. rtlsdr_demod_write_reg(dev, 1, 0x15, 0x00, 1);
  416. rtlsdr_demod_write_reg(dev, 1, 0x16, 0x0000, 2);
  417. /* clear both DDC shift and IF frequency registers */
  418. for (i = 0; i < 6; i++)
  419. rtlsdr_demod_write_reg(dev, 1, 0x16 + i, 0x00, 1);
  420. /* set FIR coefficients */
  421. for (i = 0; i < sizeof (fir_coeff); i++)
  422. rtlsdr_demod_write_reg(dev, 1, 0x1c + i, fir_coeff[i], 1);
  423. /* enable SDR mode, disable DAGC (bit 5) */
  424. rtlsdr_demod_write_reg(dev, 0, 0x19, 0x05, 1);
  425. /* init FSM state-holding register */
  426. rtlsdr_demod_write_reg(dev, 1, 0x93, 0xf0, 1);
  427. /* disable AGC (en_dagc, bit 0) (this seems to have no effect) */
  428. rtlsdr_demod_write_reg(dev, 1, 0x11, 0x00, 1);
  429. /* disable PID filter (enable_PID = 0) */
  430. rtlsdr_demod_write_reg(dev, 0, 0x61, 0x60, 1);
  431. /* opt_adc_iq = 0, default ADC_I/ADC_Q datapath */
  432. rtlsdr_demod_write_reg(dev, 0, 0x06, 0x80, 1);
  433. /* Enable Zero-IF mode (en_bbin bit), DC cancellation (en_dc_est),
  434. * IQ estimation/compensation (en_iq_comp, en_iq_est) */
  435. rtlsdr_demod_write_reg(dev, 1, 0xb1, 0x1b, 1);
  436. /* disable 4.096 MHz clock output on pin TP_CK0 */
  437. rtlsdr_demod_write_reg(dev, 0, 0x0d, 0x83, 1);
  438. }
  439. int rtlsdr_deinit_baseband(rtlsdr_dev_t *dev)
  440. {
  441. int r = 0;
  442. if (!dev)
  443. return -1;
  444. if (dev->tuner && dev->tuner->exit) {
  445. rtlsdr_set_i2c_repeater(dev, 1);
  446. r = dev->tuner->exit(dev); /* deinitialize tuner */
  447. rtlsdr_set_i2c_repeater(dev, 0);
  448. }
  449. /* poweroff demodulator and ADCs */
  450. rtlsdr_write_reg(dev, SYSB, DEMOD_CTL, 0x20, 1);
  451. return r;
  452. }
  453. int rtlsdr_set_xtal_freq(rtlsdr_dev_t *dev, uint32_t rtl_freq, uint32_t tuner_freq)
  454. {
  455. int r = 0;
  456. if (!dev)
  457. return -1;
  458. if (rtl_freq > 0 &&
  459. (rtl_freq < MIN_RTL_XTAL_FREQ || rtl_freq > MAX_RTL_XTAL_FREQ))
  460. return -2;
  461. if (rtl_freq > 0 && dev->rtl_xtal != rtl_freq) {
  462. dev->rtl_xtal = rtl_freq;
  463. /* update xtal-dependent settings */
  464. if (dev->rate)
  465. r = rtlsdr_set_sample_rate(dev, dev->rate);
  466. }
  467. if (dev->tun_xtal != tuner_freq) {
  468. if (0 == tuner_freq)
  469. dev->tun_xtal = dev->rtl_xtal;
  470. else
  471. dev->tun_xtal = tuner_freq;
  472. /* read corrected clock value into e4k structure */
  473. if (rtlsdr_get_xtal_freq(dev, NULL, &dev->e4k_s.vco.fosc))
  474. return -3;
  475. /* update xtal-dependent settings */
  476. if (dev->freq)
  477. r = rtlsdr_set_center_freq(dev, dev->freq);
  478. }
  479. return r;
  480. }
  481. int rtlsdr_get_xtal_freq(rtlsdr_dev_t *dev, uint32_t *rtl_freq, uint32_t *tuner_freq)
  482. {
  483. if (!dev)
  484. return -1;
  485. #define APPLY_PPM_CORR(val,ppm) (((val) * (1.0 + (ppm) / 1e6)))
  486. if (rtl_freq)
  487. *rtl_freq = (uint32_t) APPLY_PPM_CORR(dev->rtl_xtal, dev->corr);
  488. if (tuner_freq)
  489. *tuner_freq = (uint32_t) APPLY_PPM_CORR(dev->tun_xtal, dev->corr);
  490. return 0;
  491. }
  492. int rtlsdr_get_usb_strings(rtlsdr_dev_t *dev, char *manufact, char *product,
  493. char *serial)
  494. {
  495. struct libusb_device_descriptor dd;
  496. libusb_device *device = NULL;
  497. const int buf_max = 256;
  498. int r = 0;
  499. if (!dev || !dev->devh)
  500. return -1;
  501. device = libusb_get_device(dev->devh);
  502. r = libusb_get_device_descriptor(device, &dd);
  503. if (r < 0)
  504. return -1;
  505. if (manufact) {
  506. memset(manufact, 0, buf_max);
  507. libusb_get_string_descriptor_ascii(dev->devh, dd.iManufacturer,
  508. (unsigned char *)manufact,
  509. buf_max);
  510. }
  511. if (product) {
  512. memset(product, 0, buf_max);
  513. libusb_get_string_descriptor_ascii(dev->devh, dd.iProduct,
  514. (unsigned char *)product,
  515. buf_max);
  516. }
  517. if (serial) {
  518. memset(serial, 0, buf_max);
  519. libusb_get_string_descriptor_ascii(dev->devh, dd.iSerialNumber,
  520. (unsigned char *)serial,
  521. buf_max);
  522. }
  523. return 0;
  524. }
  525. int rtlsdr_set_center_freq(rtlsdr_dev_t *dev, uint32_t freq)
  526. {
  527. int r = -1;
  528. if (!dev || !dev->tuner)
  529. return -1;
  530. if (dev->tuner->set_freq) {
  531. rtlsdr_set_i2c_repeater(dev, 1);
  532. r = dev->tuner->set_freq(dev, freq);
  533. rtlsdr_set_i2c_repeater(dev, 0);
  534. if (!r)
  535. dev->freq = freq;
  536. else
  537. dev->freq = 0;
  538. }
  539. return r;
  540. }
  541. uint32_t rtlsdr_get_center_freq(rtlsdr_dev_t *dev)
  542. {
  543. if (!dev)
  544. return 0;
  545. return dev->freq;
  546. }
  547. int rtlsdr_set_freq_correction(rtlsdr_dev_t *dev, int ppm)
  548. {
  549. int r = 0;
  550. if (!dev)
  551. return -1;
  552. if (dev->corr == ppm)
  553. return -2;
  554. dev->corr = ppm;
  555. /* read corrected clock value into e4k structure */
  556. if (rtlsdr_get_xtal_freq(dev, NULL, &dev->e4k_s.vco.fosc))
  557. return -3;
  558. #if 0
  559. if (dev->rate) /* reset sample rate to apply new correction value */
  560. r |= rtlsdr_set_sample_rate(dev, dev->rate);
  561. #endif
  562. if (dev->freq) /* retune to apply new correction value */
  563. r |= rtlsdr_set_center_freq(dev, dev->freq);
  564. return r;
  565. }
  566. int rtlsdr_get_freq_correction(rtlsdr_dev_t *dev)
  567. {
  568. if (!dev)
  569. return 0;
  570. return dev->corr;
  571. }
  572. enum rtlsdr_tuner rtlsdr_get_tuner_type(rtlsdr_dev_t *dev)
  573. {
  574. if (!dev)
  575. return RTLSDR_TUNER_UNKNOWN;
  576. return dev->tuner_type;
  577. }
  578. int rtlsdr_get_tuner_gains(rtlsdr_dev_t *dev, int *gains)
  579. {
  580. /* all gain values are expressed in tenths of a dB */
  581. const int e4k_gains[] = { -10, 15, 40, 65, 90, 115, 140, 165, 190, 215,
  582. 240, 290, 340, 420 };
  583. const int fc0012_gains[] = { -99, -40, 71, 179, 192 };
  584. const int fc0013_gains[] = { -63, 71, 191, 197 };
  585. const int fc2580_gains[] = { 0 /* no gain values */ };
  586. int *ptr = NULL;
  587. int len = 0;
  588. if (!dev)
  589. return -1;
  590. switch (dev->tuner_type) {
  591. case RTLSDR_TUNER_E4000:
  592. ptr = (int *)e4k_gains; len = sizeof(e4k_gains);
  593. break;
  594. case RTLSDR_TUNER_FC0012:
  595. ptr = (int *)fc0012_gains; len = sizeof(fc0012_gains);
  596. break;
  597. case RTLSDR_TUNER_FC0013:
  598. ptr = (int *)fc0013_gains; len = sizeof(fc0013_gains);
  599. break;
  600. case RTLSDR_TUNER_FC2580:
  601. ptr = (int *)fc2580_gains; len = sizeof(fc2580_gains);
  602. break;
  603. default:
  604. fprintf(stderr, "Invalid tuner type %d\n", dev->tuner_type);
  605. break;
  606. }
  607. if (!gains) { /* no buffer provided, just return the count */
  608. return len / sizeof(int);
  609. } else {
  610. if (len)
  611. memcpy(gains, ptr, len);
  612. return len / sizeof(int);
  613. }
  614. }
  615. int rtlsdr_set_tuner_gain(rtlsdr_dev_t *dev, int gain)
  616. {
  617. int r = 0;
  618. if (!dev || !dev->tuner)
  619. return -1;
  620. if (dev->tuner->set_gain) {
  621. rtlsdr_set_i2c_repeater(dev, 1);
  622. r = dev->tuner->set_gain((void *)dev, gain);
  623. rtlsdr_set_i2c_repeater(dev, 0);
  624. }
  625. if (!r)
  626. dev->gain = gain;
  627. else
  628. dev->gain = 0;
  629. return r;
  630. }
  631. int rtlsdr_get_tuner_gain(rtlsdr_dev_t *dev)
  632. {
  633. if (!dev)
  634. return 0;
  635. return dev->gain;
  636. }
  637. int rtlsdr_set_tuner_if_gain(rtlsdr_dev_t *dev, int stage, int gain)
  638. {
  639. int r = 0;
  640. if (!dev || !dev->tuner)
  641. return -1;
  642. if (dev->tuner->set_if_gain) {
  643. rtlsdr_set_i2c_repeater(dev, 1);
  644. r = dev->tuner->set_if_gain(dev, stage, gain);
  645. rtlsdr_set_i2c_repeater(dev, 0);
  646. }
  647. return r;
  648. }
  649. int rtlsdr_set_tuner_gain_mode(rtlsdr_dev_t *dev, int mode)
  650. {
  651. int r = 0;
  652. if (!dev || !dev->tuner)
  653. return -1;
  654. if (dev->tuner->set_gain_mode) {
  655. rtlsdr_set_i2c_repeater(dev, 1);
  656. r = dev->tuner->set_gain_mode((void *)dev, mode);
  657. rtlsdr_set_i2c_repeater(dev, 0);
  658. }
  659. return r;
  660. }
  661. /* two raised to the power of n */
  662. #define TWO_POW(n) ((double)(1ULL<<(n)))
  663. int rtlsdr_set_sample_rate(rtlsdr_dev_t *dev, uint32_t samp_rate)
  664. {
  665. uint16_t tmp;
  666. uint32_t rsamp_ratio;
  667. double real_rate;
  668. uint32_t rtl_freq = dev->rtl_xtal;
  669. if (!dev)
  670. return -1;
  671. /* check for the maximum rate the resampler supports */
  672. if (samp_rate > MAX_SAMP_RATE)
  673. samp_rate = MAX_SAMP_RATE;
  674. #if 0
  675. /* read corrected clock value */
  676. if (rtlsdr_get_xtal_freq(dev, &rtl_freq, NULL))
  677. return -2;
  678. if (samp_rate == MAX_SAMP_RATE && rtl_freq != DEF_RTL_XTAL_FREQ)
  679. rtl_freq = DEF_RTL_XTAL_FREQ;
  680. #endif
  681. rsamp_ratio = (rtl_freq * TWO_POW(22)) / samp_rate;
  682. rsamp_ratio &= ~3;
  683. real_rate = (rtl_freq * TWO_POW(22)) / rsamp_ratio;
  684. if ( ((double)samp_rate) != real_rate )
  685. fprintf(stderr, "Exact sample rate is: %f Hz\n", real_rate);
  686. if (dev->tuner && dev->tuner->set_bw) {
  687. rtlsdr_set_i2c_repeater(dev, 1);
  688. dev->tuner->set_bw(dev, (int)real_rate);
  689. rtlsdr_set_i2c_repeater(dev, 0);
  690. }
  691. dev->rate = (uint32_t)real_rate;
  692. tmp = (rsamp_ratio >> 16);
  693. rtlsdr_demod_write_reg(dev, 1, 0x9f, tmp, 2);
  694. tmp = rsamp_ratio & 0xffff;
  695. rtlsdr_demod_write_reg(dev, 1, 0xa1, tmp, 2);
  696. /* reset demod (bit 3, soft_rst) */
  697. rtlsdr_demod_write_reg(dev, 1, 0x01, 0x14, 1);
  698. rtlsdr_demod_write_reg(dev, 1, 0x01, 0x10, 1);
  699. return 0;
  700. }
  701. uint32_t rtlsdr_get_sample_rate(rtlsdr_dev_t *dev)
  702. {
  703. if (!dev)
  704. return 0;
  705. return dev->rate;
  706. }
  707. int rtlsdr_set_testmode(rtlsdr_dev_t *dev, int on)
  708. {
  709. if (!dev)
  710. return -1;
  711. return rtlsdr_demod_write_reg(dev, 0, 0x19, on ? 0x03 : 0x05, 1);
  712. }
  713. int rtlsdr_set_agc_mode(rtlsdr_dev_t *dev, int on)
  714. {
  715. if (!dev)
  716. return -1;
  717. return rtlsdr_demod_write_reg(dev, 0, 0x19, on ? 0x25 : 0x05, 1);
  718. }
  719. static rtlsdr_dongle_t *find_known_device(uint16_t vid, uint16_t pid)
  720. {
  721. unsigned int i;
  722. rtlsdr_dongle_t *device = NULL;
  723. for (i = 0; i < sizeof(known_devices)/sizeof(rtlsdr_dongle_t); i++ ) {
  724. if (known_devices[i].vid == vid && known_devices[i].pid == pid) {
  725. device = &known_devices[i];
  726. break;
  727. }
  728. }
  729. return device;
  730. }
  731. uint32_t rtlsdr_get_device_count(void)
  732. {
  733. int i;
  734. libusb_context *ctx;
  735. libusb_device **list;
  736. uint32_t device_count = 0;
  737. struct libusb_device_descriptor dd;
  738. ssize_t cnt;
  739. libusb_init(&ctx);
  740. cnt = libusb_get_device_list(ctx, &list);
  741. for (i = 0; i < cnt; i++) {
  742. libusb_get_device_descriptor(list[i], &dd);
  743. if (find_known_device(dd.idVendor, dd.idProduct))
  744. device_count++;
  745. }
  746. libusb_free_device_list(list, 1);
  747. libusb_exit(ctx);
  748. return device_count;
  749. }
  750. const char *rtlsdr_get_device_name(uint32_t index)
  751. {
  752. int i;
  753. libusb_context *ctx;
  754. libusb_device **list;
  755. struct libusb_device_descriptor dd;
  756. rtlsdr_dongle_t *device = NULL;
  757. uint32_t device_count = 0;
  758. ssize_t cnt;
  759. libusb_init(&ctx);
  760. cnt = libusb_get_device_list(ctx, &list);
  761. for (i = 0; i < cnt; i++) {
  762. libusb_get_device_descriptor(list[i], &dd);
  763. device = find_known_device(dd.idVendor, dd.idProduct);
  764. if (device) {
  765. device_count++;
  766. if (index == device_count - 1)
  767. break;
  768. }
  769. }
  770. libusb_free_device_list(list, 1);
  771. libusb_exit(ctx);
  772. if (device)
  773. return device->name;
  774. else
  775. return "";
  776. }
  777. int rtlsdr_get_device_usb_strings(uint32_t index, char *manufact,
  778. char *product, char *serial)
  779. {
  780. int r = -2;
  781. int i;
  782. libusb_context *ctx;
  783. libusb_device **list;
  784. struct libusb_device_descriptor dd;
  785. rtlsdr_dongle_t *device = NULL;
  786. rtlsdr_dev_t devt;
  787. uint32_t device_count = 0;
  788. ssize_t cnt;
  789. libusb_init(&ctx);
  790. cnt = libusb_get_device_list(ctx, &list);
  791. for (i = 0; i < cnt; i++) {
  792. libusb_get_device_descriptor(list[i], &dd);
  793. device = find_known_device(dd.idVendor, dd.idProduct);
  794. if (device) {
  795. device_count++;
  796. if (index == device_count - 1) {
  797. r = libusb_open(list[i], &devt.devh);
  798. if (!r) {
  799. r = rtlsdr_get_usb_strings(&devt,
  800. manufact,
  801. product,
  802. serial);
  803. libusb_close(devt.devh);
  804. }
  805. break;
  806. }
  807. }
  808. }
  809. libusb_free_device_list(list, 1);
  810. libusb_exit(ctx);
  811. return r;
  812. }
  813. int rtlsdr_open(rtlsdr_dev_t **out_dev, uint32_t index)
  814. {
  815. int r;
  816. int i;
  817. libusb_device **list;
  818. rtlsdr_dev_t *dev = NULL;
  819. libusb_device *device = NULL;
  820. uint32_t device_count = 0;
  821. struct libusb_device_descriptor dd;
  822. uint8_t reg;
  823. ssize_t cnt;
  824. dev = malloc(sizeof(rtlsdr_dev_t));
  825. if (NULL == dev)
  826. return -ENOMEM;
  827. memset(dev, 0, sizeof(rtlsdr_dev_t));
  828. libusb_init(&dev->ctx);
  829. cnt = libusb_get_device_list(dev->ctx, &list);
  830. for (i = 0; i < cnt; i++) {
  831. device = list[i];
  832. libusb_get_device_descriptor(list[i], &dd);
  833. if (find_known_device(dd.idVendor, dd.idProduct)) {
  834. device_count++;
  835. }
  836. if (index == device_count - 1)
  837. break;
  838. device = NULL;
  839. }
  840. if (!device) {
  841. r = -1;
  842. goto err;
  843. }
  844. r = libusb_open(device, &dev->devh);
  845. if (r < 0) {
  846. libusb_free_device_list(list, 1);
  847. fprintf(stderr, "usb_open error %d\n", r);
  848. goto err;
  849. }
  850. libusb_free_device_list(list, 1);
  851. r = libusb_claim_interface(dev->devh, 0);
  852. if (r < 0) {
  853. fprintf(stderr, "usb_claim_interface error %d\n", r);
  854. goto err;
  855. }
  856. dev->rtl_xtal = DEF_RTL_XTAL_FREQ;
  857. rtlsdr_init_baseband(dev);
  858. /* Probe tuners */
  859. rtlsdr_set_i2c_repeater(dev, 1);
  860. reg = rtlsdr_i2c_read_reg(dev, E4K_I2C_ADDR, E4K_CHECK_ADDR);
  861. if (reg == E4K_CHECK_VAL) {
  862. fprintf(stderr, "Found Elonics E4000 tuner\n");
  863. dev->tuner_type = RTLSDR_TUNER_E4000;
  864. goto found;
  865. }
  866. reg = rtlsdr_i2c_read_reg(dev, FC0013_I2C_ADDR, FC0013_CHECK_ADDR);
  867. if (reg == FC0013_CHECK_VAL) {
  868. fprintf(stderr, "Found Fitipower FC0013 tuner\n");
  869. rtlsdr_set_gpio_output(dev, 6);
  870. dev->tuner_type = RTLSDR_TUNER_FC0013;
  871. goto found;
  872. }
  873. /* initialise GPIOs */
  874. rtlsdr_set_gpio_output(dev, 5);
  875. /* reset tuner before probing */
  876. rtlsdr_set_gpio_bit(dev, 5, 1);
  877. rtlsdr_set_gpio_bit(dev, 5, 0);
  878. reg = rtlsdr_i2c_read_reg(dev, FC2580_I2C_ADDR, FC2580_CHECK_ADDR);
  879. if ((reg & 0x7f) == FC2580_CHECK_VAL) {
  880. fprintf(stderr, "Found FCI 2580 tuner\n");
  881. dev->tuner_type = RTLSDR_TUNER_FC2580;
  882. goto found;
  883. }
  884. reg = rtlsdr_i2c_read_reg(dev, FC0012_I2C_ADDR, FC0012_CHECK_ADDR);
  885. if (reg == FC0012_CHECK_VAL) {
  886. fprintf(stderr, "Found Fitipower FC0012 tuner\n");
  887. rtlsdr_set_gpio_output(dev, 6);
  888. dev->tuner_type = RTLSDR_TUNER_FC0012;
  889. goto found;
  890. }
  891. found:
  892. if (dev->tuner_type == RTLSDR_TUNER_UNKNOWN) {
  893. r = -1;
  894. goto err;
  895. }
  896. dev->tuner = &tuners[dev->tuner_type];
  897. dev->tun_xtal = dev->rtl_xtal; /* use the rtl clock value by default */
  898. if (dev->tuner->init)
  899. r = dev->tuner->init(dev);
  900. rtlsdr_set_i2c_repeater(dev, 0);
  901. *out_dev = dev;
  902. return 0;
  903. err:
  904. if (dev) {
  905. if (dev->ctx)
  906. libusb_exit(dev->ctx);
  907. free(dev);
  908. }
  909. return r;
  910. }
  911. int rtlsdr_close(rtlsdr_dev_t *dev)
  912. {
  913. if (!dev)
  914. return -1;
  915. /* block until all async operations have been completed (if any) */
  916. while (RTLSDR_INACTIVE != dev->async_status)
  917. usleep(10);
  918. rtlsdr_deinit_baseband(dev);
  919. libusb_release_interface(dev->devh, 0);
  920. libusb_close(dev->devh);
  921. libusb_exit(dev->ctx);
  922. free(dev);
  923. return 0;
  924. }
  925. int rtlsdr_reset_buffer(rtlsdr_dev_t *dev)
  926. {
  927. if (!dev)
  928. return -1;
  929. rtlsdr_write_reg(dev, USBB, USB_EPA_CTL, 0x1002, 2);
  930. rtlsdr_write_reg(dev, USBB, USB_EPA_CTL, 0x0000, 2);
  931. return 0;
  932. }
  933. int rtlsdr_read_sync(rtlsdr_dev_t *dev, void *buf, int len, int *n_read)
  934. {
  935. if (!dev)
  936. return -1;
  937. return libusb_bulk_transfer(dev->devh, 0x81, buf, len, n_read, BULK_TIMEOUT);
  938. }
  939. static void LIBUSB_CALL _libusb_callback(struct libusb_transfer *xfer)
  940. {
  941. rtlsdr_dev_t *dev = (rtlsdr_dev_t *)xfer->user_data;
  942. if (LIBUSB_TRANSFER_COMPLETED == xfer->status) {
  943. if (dev->cb)
  944. dev->cb(xfer->buffer, xfer->actual_length, dev->cb_ctx);
  945. libusb_submit_transfer(xfer); /* resubmit transfer */
  946. } else if (LIBUSB_TRANSFER_CANCELLED == xfer->status) {
  947. /* nothing to do */
  948. } else {
  949. /*fprintf(stderr, "transfer status: %d\n", xfer->status);*/
  950. }
  951. }
  952. int rtlsdr_wait_async(rtlsdr_dev_t *dev, rtlsdr_read_async_cb_t cb, void *ctx)
  953. {
  954. return rtlsdr_read_async(dev, cb, ctx, 0, 0);
  955. }
  956. static int _rtlsdr_alloc_async_buffers(rtlsdr_dev_t *dev)
  957. {
  958. unsigned int i;
  959. if (!dev)
  960. return -1;
  961. if (!dev->xfer) {
  962. dev->xfer = malloc(dev->xfer_buf_num *
  963. sizeof(struct libusb_transfer *));
  964. for(i = 0; i < dev->xfer_buf_num; ++i)
  965. dev->xfer[i] = libusb_alloc_transfer(0);
  966. }
  967. if (!dev->xfer_buf) {
  968. dev->xfer_buf = malloc(dev->xfer_buf_num *
  969. sizeof(unsigned char *));
  970. for(i = 0; i < dev->xfer_buf_num; ++i)
  971. dev->xfer_buf[i] = malloc(dev->xfer_buf_len);
  972. }
  973. return 0;
  974. }
  975. static int _rtlsdr_free_async_buffers(rtlsdr_dev_t *dev)
  976. {
  977. unsigned int i;
  978. if (!dev)
  979. return -1;
  980. if (dev->xfer) {
  981. for(i = 0; i < dev->xfer_buf_num; ++i) {
  982. if (dev->xfer[i]) {
  983. libusb_free_transfer(dev->xfer[i]);
  984. }
  985. }
  986. free(dev->xfer);
  987. dev->xfer = NULL;
  988. }
  989. if (dev->xfer_buf) {
  990. for(i = 0; i < dev->xfer_buf_num; ++i) {
  991. if (dev->xfer_buf[i])
  992. free(dev->xfer_buf[i]);
  993. }
  994. free(dev->xfer_buf);
  995. dev->xfer_buf = NULL;
  996. }
  997. return 0;
  998. }
  999. int rtlsdr_read_async(rtlsdr_dev_t *dev, rtlsdr_read_async_cb_t cb, void *ctx,
  1000. uint32_t buf_num, uint32_t buf_len)
  1001. {
  1002. unsigned int i;
  1003. int r = 0;
  1004. struct timeval tv = { 1, 0 };
  1005. enum rtlsdr_async_status next_status = RTLSDR_INACTIVE;
  1006. if (!dev)
  1007. return -1;
  1008. if (RTLSDR_INACTIVE != dev->async_status)
  1009. return -2;
  1010. dev->async_status = RTLSDR_RUNNING;
  1011. dev->cb = cb;
  1012. dev->cb_ctx = ctx;
  1013. if (buf_num > 0)
  1014. dev->xfer_buf_num = buf_num;
  1015. else
  1016. dev->xfer_buf_num = DEFAULT_BUF_NUMBER;
  1017. if (buf_len > 0 && buf_len % 512 == 0) /* len must be multiple of 512 */
  1018. dev->xfer_buf_len = buf_len;
  1019. else
  1020. dev->xfer_buf_len = DEFAULT_BUF_LENGTH;
  1021. _rtlsdr_alloc_async_buffers(dev);
  1022. for(i = 0; i < dev->xfer_buf_num; ++i) {
  1023. libusb_fill_bulk_transfer(dev->xfer[i],
  1024. dev->devh,
  1025. 0x81,
  1026. dev->xfer_buf[i],
  1027. dev->xfer_buf_len,
  1028. _libusb_callback,
  1029. (void *)dev,
  1030. BULK_TIMEOUT);
  1031. libusb_submit_transfer(dev->xfer[i]);
  1032. }
  1033. while (RTLSDR_INACTIVE != dev->async_status) {
  1034. r = libusb_handle_events_timeout(dev->ctx, &tv);
  1035. if (r < 0) {
  1036. /*fprintf(stderr, "handle_events returned: %d\n", r);*/
  1037. if (r == LIBUSB_ERROR_INTERRUPTED) /* stray signal */
  1038. continue;
  1039. break;
  1040. }
  1041. if (RTLSDR_CANCELING == dev->async_status) {
  1042. next_status = RTLSDR_INACTIVE;
  1043. if (!dev->xfer)
  1044. break;
  1045. for(i = 0; i < dev->xfer_buf_num; ++i) {
  1046. if (!dev->xfer[i])
  1047. continue;
  1048. if (LIBUSB_TRANSFER_CANCELLED !=
  1049. dev->xfer[i]->status) {
  1050. libusb_cancel_transfer(dev->xfer[i]);
  1051. next_status = RTLSDR_CANCELING;
  1052. }
  1053. }
  1054. if (RTLSDR_INACTIVE == next_status)
  1055. break;
  1056. }
  1057. }
  1058. _rtlsdr_free_async_buffers(dev);
  1059. dev->async_status = next_status;
  1060. return r;
  1061. }
  1062. int rtlsdr_cancel_async(rtlsdr_dev_t *dev)
  1063. {
  1064. if (!dev)
  1065. return -1;
  1066. /* if streaming, try to cancel gracefully */
  1067. if (RTLSDR_RUNNING == dev->async_status) {
  1068. dev->async_status = RTLSDR_CANCELING;
  1069. return 0;
  1070. }
  1071. /* if called while in pending state, change the state forcefully */
  1072. if (RTLSDR_INACTIVE != dev->async_status) {
  1073. dev->async_status = RTLSDR_INACTIVE;
  1074. return 0;
  1075. }
  1076. return -2;
  1077. }
  1078. uint32_t rtlsdr_get_tuner_clock(void *dev)
  1079. {
  1080. uint32_t tuner_freq;
  1081. if (!dev)
  1082. return 0;
  1083. /* read corrected clock value */
  1084. if (rtlsdr_get_xtal_freq((rtlsdr_dev_t *)dev, NULL, &tuner_freq))
  1085. return 0;
  1086. return tuner_freq;
  1087. }
  1088. int rtlsdr_i2c_write_fn(void *dev, uint8_t addr, uint8_t *buf, int len)
  1089. {
  1090. if (dev)
  1091. return rtlsdr_i2c_write(((rtlsdr_dev_t *)dev), addr, buf, len);
  1092. return -1;
  1093. }
  1094. int rtlsdr_i2c_read_fn(void *dev, uint8_t addr, uint8_t *buf, int len)
  1095. {
  1096. if (dev)
  1097. return rtlsdr_i2c_read(((rtlsdr_dev_t *)dev), addr, buf, len);
  1098. return -1;
  1099. }