soundfont.c 38 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497
  1. /*
  2. * Soundfont generic routines.
  3. * It is intended that these should be used by any driver that is willing
  4. * to accept soundfont patches.
  5. *
  6. * Copyright (C) 1999 Steve Ratcliffe
  7. * Copyright (c) 1999-2000 Takashi Iwai <tiwai@suse.de>
  8. *
  9. * This program is free software; you can redistribute it and/or modify
  10. * it under the terms of the GNU General Public License as published by
  11. * the Free Software Foundation; either version 2 of the License, or
  12. * (at your option) any later version.
  13. *
  14. * This program is distributed in the hope that it will be useful,
  15. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  17. * GNU General Public License for more details.
  18. *
  19. * You should have received a copy of the GNU General Public License
  20. * along with this program; if not, write to the Free Software
  21. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  22. */
  23. /*
  24. * Deal with reading in of a soundfont. Code follows the OSS way
  25. * of doing things so that the old sfxload utility can be used.
  26. * Everything may change when there is an alsa way of doing things.
  27. */
  28. #include <linux/uaccess.h>
  29. #include <linux/slab.h>
  30. #include <linux/export.h>
  31. #include <sound/core.h>
  32. #include <sound/soundfont.h>
  33. #include <sound/seq_oss_legacy.h>
  34. /* Prototypes for static functions */
  35. static int open_patch(struct snd_sf_list *sflist, const char __user *data,
  36. int count, int client);
  37. static struct snd_soundfont *newsf(struct snd_sf_list *sflist, int type, char *name);
  38. static int is_identical_font(struct snd_soundfont *sf, int type, unsigned char *name);
  39. static int close_patch(struct snd_sf_list *sflist);
  40. static int probe_data(struct snd_sf_list *sflist, int sample_id);
  41. static void set_zone_counter(struct snd_sf_list *sflist,
  42. struct snd_soundfont *sf, struct snd_sf_zone *zp);
  43. static struct snd_sf_zone *sf_zone_new(struct snd_sf_list *sflist,
  44. struct snd_soundfont *sf);
  45. static void set_sample_counter(struct snd_sf_list *sflist,
  46. struct snd_soundfont *sf, struct snd_sf_sample *sp);
  47. static struct snd_sf_sample *sf_sample_new(struct snd_sf_list *sflist,
  48. struct snd_soundfont *sf);
  49. static void sf_sample_delete(struct snd_sf_list *sflist,
  50. struct snd_soundfont *sf, struct snd_sf_sample *sp);
  51. static int load_map(struct snd_sf_list *sflist, const void __user *data, int count);
  52. static int load_info(struct snd_sf_list *sflist, const void __user *data, long count);
  53. static int remove_info(struct snd_sf_list *sflist, struct snd_soundfont *sf,
  54. int bank, int instr);
  55. static void init_voice_info(struct soundfont_voice_info *avp);
  56. static void init_voice_parm(struct soundfont_voice_parm *pp);
  57. static struct snd_sf_sample *set_sample(struct snd_soundfont *sf,
  58. struct soundfont_voice_info *avp);
  59. static struct snd_sf_sample *find_sample(struct snd_soundfont *sf, int sample_id);
  60. static int load_data(struct snd_sf_list *sflist, const void __user *data, long count);
  61. static void rebuild_presets(struct snd_sf_list *sflist);
  62. static void add_preset(struct snd_sf_list *sflist, struct snd_sf_zone *cur);
  63. static void delete_preset(struct snd_sf_list *sflist, struct snd_sf_zone *zp);
  64. static struct snd_sf_zone *search_first_zone(struct snd_sf_list *sflist,
  65. int bank, int preset, int key);
  66. static int search_zones(struct snd_sf_list *sflist, int *notep, int vel,
  67. int preset, int bank, struct snd_sf_zone **table,
  68. int max_layers, int level);
  69. static int get_index(int bank, int instr, int key);
  70. static void snd_sf_init(struct snd_sf_list *sflist);
  71. static void snd_sf_clear(struct snd_sf_list *sflist);
  72. /*
  73. * lock access to sflist
  74. */
  75. static void
  76. lock_preset(struct snd_sf_list *sflist)
  77. {
  78. unsigned long flags;
  79. mutex_lock(&sflist->presets_mutex);
  80. spin_lock_irqsave(&sflist->lock, flags);
  81. sflist->presets_locked = 1;
  82. spin_unlock_irqrestore(&sflist->lock, flags);
  83. }
  84. /*
  85. * remove lock
  86. */
  87. static void
  88. unlock_preset(struct snd_sf_list *sflist)
  89. {
  90. unsigned long flags;
  91. spin_lock_irqsave(&sflist->lock, flags);
  92. sflist->presets_locked = 0;
  93. spin_unlock_irqrestore(&sflist->lock, flags);
  94. mutex_unlock(&sflist->presets_mutex);
  95. }
  96. /*
  97. * close the patch if the patch was opened by this client.
  98. */
  99. int
  100. snd_soundfont_close_check(struct snd_sf_list *sflist, int client)
  101. {
  102. unsigned long flags;
  103. spin_lock_irqsave(&sflist->lock, flags);
  104. if (sflist->open_client == client) {
  105. spin_unlock_irqrestore(&sflist->lock, flags);
  106. return close_patch(sflist);
  107. }
  108. spin_unlock_irqrestore(&sflist->lock, flags);
  109. return 0;
  110. }
  111. /*
  112. * Deal with a soundfont patch. Any driver could use these routines
  113. * although it was designed for the AWE64.
  114. *
  115. * The sample_write and callargs pararameters allow a callback into
  116. * the actual driver to write sample data to the board or whatever
  117. * it wants to do with it.
  118. */
  119. int
  120. snd_soundfont_load(struct snd_sf_list *sflist, const void __user *data,
  121. long count, int client)
  122. {
  123. struct soundfont_patch_info patch;
  124. unsigned long flags;
  125. int rc;
  126. if (count < (long)sizeof(patch)) {
  127. snd_printk(KERN_ERR "patch record too small %ld\n", count);
  128. return -EINVAL;
  129. }
  130. if (copy_from_user(&patch, data, sizeof(patch)))
  131. return -EFAULT;
  132. count -= sizeof(patch);
  133. data += sizeof(patch);
  134. if (patch.key != SNDRV_OSS_SOUNDFONT_PATCH) {
  135. snd_printk(KERN_ERR "The wrong kind of patch %x\n", patch.key);
  136. return -EINVAL;
  137. }
  138. if (count < patch.len) {
  139. snd_printk(KERN_ERR "Patch too short %ld, need %d\n",
  140. count, patch.len);
  141. return -EINVAL;
  142. }
  143. if (patch.len < 0) {
  144. snd_printk(KERN_ERR "poor length %d\n", patch.len);
  145. return -EINVAL;
  146. }
  147. if (patch.type == SNDRV_SFNT_OPEN_PATCH) {
  148. /* grab sflist to open */
  149. lock_preset(sflist);
  150. rc = open_patch(sflist, data, count, client);
  151. unlock_preset(sflist);
  152. return rc;
  153. }
  154. /* check if other client already opened patch */
  155. spin_lock_irqsave(&sflist->lock, flags);
  156. if (sflist->open_client != client) {
  157. spin_unlock_irqrestore(&sflist->lock, flags);
  158. return -EBUSY;
  159. }
  160. spin_unlock_irqrestore(&sflist->lock, flags);
  161. lock_preset(sflist);
  162. rc = -EINVAL;
  163. switch (patch.type) {
  164. case SNDRV_SFNT_LOAD_INFO:
  165. rc = load_info(sflist, data, count);
  166. break;
  167. case SNDRV_SFNT_LOAD_DATA:
  168. rc = load_data(sflist, data, count);
  169. break;
  170. case SNDRV_SFNT_CLOSE_PATCH:
  171. rc = close_patch(sflist);
  172. break;
  173. case SNDRV_SFNT_REPLACE_DATA:
  174. /*rc = replace_data(&patch, data, count);*/
  175. break;
  176. case SNDRV_SFNT_MAP_PRESET:
  177. rc = load_map(sflist, data, count);
  178. break;
  179. case SNDRV_SFNT_PROBE_DATA:
  180. rc = probe_data(sflist, patch.optarg);
  181. break;
  182. case SNDRV_SFNT_REMOVE_INFO:
  183. /* patch must be opened */
  184. if (!sflist->currsf) {
  185. snd_printk(KERN_ERR "soundfont: remove_info: "
  186. "patch not opened\n");
  187. rc = -EINVAL;
  188. } else {
  189. int bank, instr;
  190. bank = ((unsigned short)patch.optarg >> 8) & 0xff;
  191. instr = (unsigned short)patch.optarg & 0xff;
  192. if (! remove_info(sflist, sflist->currsf, bank, instr))
  193. rc = -EINVAL;
  194. else
  195. rc = 0;
  196. }
  197. break;
  198. }
  199. unlock_preset(sflist);
  200. return rc;
  201. }
  202. /* check if specified type is special font (GUS or preset-alias) */
  203. static inline int
  204. is_special_type(int type)
  205. {
  206. type &= 0x0f;
  207. return (type == SNDRV_SFNT_PAT_TYPE_GUS ||
  208. type == SNDRV_SFNT_PAT_TYPE_MAP);
  209. }
  210. /* open patch; create sf list */
  211. static int
  212. open_patch(struct snd_sf_list *sflist, const char __user *data,
  213. int count, int client)
  214. {
  215. struct soundfont_open_parm parm;
  216. struct snd_soundfont *sf;
  217. unsigned long flags;
  218. spin_lock_irqsave(&sflist->lock, flags);
  219. if (sflist->open_client >= 0 || sflist->currsf) {
  220. spin_unlock_irqrestore(&sflist->lock, flags);
  221. return -EBUSY;
  222. }
  223. spin_unlock_irqrestore(&sflist->lock, flags);
  224. if (copy_from_user(&parm, data, sizeof(parm)))
  225. return -EFAULT;
  226. if (is_special_type(parm.type)) {
  227. parm.type |= SNDRV_SFNT_PAT_SHARED;
  228. sf = newsf(sflist, parm.type, NULL);
  229. } else
  230. sf = newsf(sflist, parm.type, parm.name);
  231. if (sf == NULL) {
  232. return -ENOMEM;
  233. }
  234. spin_lock_irqsave(&sflist->lock, flags);
  235. sflist->open_client = client;
  236. sflist->currsf = sf;
  237. spin_unlock_irqrestore(&sflist->lock, flags);
  238. return 0;
  239. }
  240. /*
  241. * Allocate a new soundfont structure.
  242. */
  243. static struct snd_soundfont *
  244. newsf(struct snd_sf_list *sflist, int type, char *name)
  245. {
  246. struct snd_soundfont *sf;
  247. /* check the shared fonts */
  248. if (type & SNDRV_SFNT_PAT_SHARED) {
  249. for (sf = sflist->fonts; sf; sf = sf->next) {
  250. if (is_identical_font(sf, type, name)) {
  251. return sf;
  252. }
  253. }
  254. }
  255. /* not found -- create a new one */
  256. sf = kzalloc(sizeof(*sf), GFP_KERNEL);
  257. if (sf == NULL)
  258. return NULL;
  259. sf->id = sflist->fonts_size;
  260. sflist->fonts_size++;
  261. /* prepend this record */
  262. sf->next = sflist->fonts;
  263. sflist->fonts = sf;
  264. sf->type = type;
  265. sf->zones = NULL;
  266. sf->samples = NULL;
  267. if (name)
  268. memcpy(sf->name, name, SNDRV_SFNT_PATCH_NAME_LEN);
  269. return sf;
  270. }
  271. /* check if the given name matches to the existing list */
  272. static int
  273. is_identical_font(struct snd_soundfont *sf, int type, unsigned char *name)
  274. {
  275. return ((sf->type & SNDRV_SFNT_PAT_SHARED) &&
  276. (sf->type & 0x0f) == (type & 0x0f) &&
  277. (name == NULL ||
  278. memcmp(sf->name, name, SNDRV_SFNT_PATCH_NAME_LEN) == 0));
  279. }
  280. /*
  281. * Close the current patch.
  282. */
  283. static int
  284. close_patch(struct snd_sf_list *sflist)
  285. {
  286. unsigned long flags;
  287. spin_lock_irqsave(&sflist->lock, flags);
  288. sflist->currsf = NULL;
  289. sflist->open_client = -1;
  290. spin_unlock_irqrestore(&sflist->lock, flags);
  291. rebuild_presets(sflist);
  292. return 0;
  293. }
  294. /* probe sample in the current list -- nothing to be loaded */
  295. static int
  296. probe_data(struct snd_sf_list *sflist, int sample_id)
  297. {
  298. /* patch must be opened */
  299. if (sflist->currsf) {
  300. /* search the specified sample by optarg */
  301. if (find_sample(sflist->currsf, sample_id))
  302. return 0;
  303. }
  304. return -EINVAL;
  305. }
  306. /*
  307. * increment zone counter
  308. */
  309. static void
  310. set_zone_counter(struct snd_sf_list *sflist, struct snd_soundfont *sf,
  311. struct snd_sf_zone *zp)
  312. {
  313. zp->counter = sflist->zone_counter++;
  314. if (sf->type & SNDRV_SFNT_PAT_LOCKED)
  315. sflist->zone_locked = sflist->zone_counter;
  316. }
  317. /*
  318. * allocate a new zone record
  319. */
  320. static struct snd_sf_zone *
  321. sf_zone_new(struct snd_sf_list *sflist, struct snd_soundfont *sf)
  322. {
  323. struct snd_sf_zone *zp;
  324. if ((zp = kzalloc(sizeof(*zp), GFP_KERNEL)) == NULL)
  325. return NULL;
  326. zp->next = sf->zones;
  327. sf->zones = zp;
  328. init_voice_info(&zp->v);
  329. set_zone_counter(sflist, sf, zp);
  330. return zp;
  331. }
  332. /*
  333. * increment sample counter
  334. */
  335. static void
  336. set_sample_counter(struct snd_sf_list *sflist, struct snd_soundfont *sf,
  337. struct snd_sf_sample *sp)
  338. {
  339. sp->counter = sflist->sample_counter++;
  340. if (sf->type & SNDRV_SFNT_PAT_LOCKED)
  341. sflist->sample_locked = sflist->sample_counter;
  342. }
  343. /*
  344. * allocate a new sample list record
  345. */
  346. static struct snd_sf_sample *
  347. sf_sample_new(struct snd_sf_list *sflist, struct snd_soundfont *sf)
  348. {
  349. struct snd_sf_sample *sp;
  350. if ((sp = kzalloc(sizeof(*sp), GFP_KERNEL)) == NULL)
  351. return NULL;
  352. sp->next = sf->samples;
  353. sf->samples = sp;
  354. set_sample_counter(sflist, sf, sp);
  355. return sp;
  356. }
  357. /*
  358. * delete sample list -- this is an exceptional job.
  359. * only the last allocated sample can be deleted.
  360. */
  361. static void
  362. sf_sample_delete(struct snd_sf_list *sflist, struct snd_soundfont *sf,
  363. struct snd_sf_sample *sp)
  364. {
  365. /* only last sample is accepted */
  366. if (sp == sf->samples) {
  367. sf->samples = sp->next;
  368. kfree(sp);
  369. }
  370. }
  371. /* load voice map */
  372. static int
  373. load_map(struct snd_sf_list *sflist, const void __user *data, int count)
  374. {
  375. struct snd_sf_zone *zp, *prevp;
  376. struct snd_soundfont *sf;
  377. struct soundfont_voice_map map;
  378. /* get the link info */
  379. if (count < (int)sizeof(map))
  380. return -EINVAL;
  381. if (copy_from_user(&map, data, sizeof(map)))
  382. return -EFAULT;
  383. if (map.map_instr < 0 || map.map_instr >= SF_MAX_INSTRUMENTS)
  384. return -EINVAL;
  385. sf = newsf(sflist, SNDRV_SFNT_PAT_TYPE_MAP|SNDRV_SFNT_PAT_SHARED, NULL);
  386. if (sf == NULL)
  387. return -ENOMEM;
  388. prevp = NULL;
  389. for (zp = sf->zones; zp; prevp = zp, zp = zp->next) {
  390. if (zp->mapped &&
  391. zp->instr == map.map_instr &&
  392. zp->bank == map.map_bank &&
  393. zp->v.low == map.map_key &&
  394. zp->v.start == map.src_instr &&
  395. zp->v.end == map.src_bank &&
  396. zp->v.fixkey == map.src_key) {
  397. /* the same mapping is already present */
  398. /* relink this record to the link head */
  399. if (prevp) {
  400. prevp->next = zp->next;
  401. zp->next = sf->zones;
  402. sf->zones = zp;
  403. }
  404. /* update the counter */
  405. set_zone_counter(sflist, sf, zp);
  406. return 0;
  407. }
  408. }
  409. /* create a new zone */
  410. if ((zp = sf_zone_new(sflist, sf)) == NULL)
  411. return -ENOMEM;
  412. zp->bank = map.map_bank;
  413. zp->instr = map.map_instr;
  414. zp->mapped = 1;
  415. if (map.map_key >= 0) {
  416. zp->v.low = map.map_key;
  417. zp->v.high = map.map_key;
  418. }
  419. zp->v.start = map.src_instr;
  420. zp->v.end = map.src_bank;
  421. zp->v.fixkey = map.src_key;
  422. zp->v.sf_id = sf->id;
  423. add_preset(sflist, zp);
  424. return 0;
  425. }
  426. /* remove the present instrument layers */
  427. static int
  428. remove_info(struct snd_sf_list *sflist, struct snd_soundfont *sf,
  429. int bank, int instr)
  430. {
  431. struct snd_sf_zone *prev, *next, *p;
  432. int removed = 0;
  433. prev = NULL;
  434. for (p = sf->zones; p; p = next) {
  435. next = p->next;
  436. if (! p->mapped &&
  437. p->bank == bank && p->instr == instr) {
  438. /* remove this layer */
  439. if (prev)
  440. prev->next = next;
  441. else
  442. sf->zones = next;
  443. removed++;
  444. kfree(p);
  445. } else
  446. prev = p;
  447. }
  448. if (removed)
  449. rebuild_presets(sflist);
  450. return removed;
  451. }
  452. /*
  453. * Read an info record from the user buffer and save it on the current
  454. * open soundfont.
  455. */
  456. static int
  457. load_info(struct snd_sf_list *sflist, const void __user *data, long count)
  458. {
  459. struct snd_soundfont *sf;
  460. struct snd_sf_zone *zone;
  461. struct soundfont_voice_rec_hdr hdr;
  462. int i;
  463. /* patch must be opened */
  464. if ((sf = sflist->currsf) == NULL)
  465. return -EINVAL;
  466. if (is_special_type(sf->type))
  467. return -EINVAL;
  468. if (count < (long)sizeof(hdr)) {
  469. printk(KERN_ERR "Soundfont error: invalid patch zone length\n");
  470. return -EINVAL;
  471. }
  472. if (copy_from_user((char*)&hdr, data, sizeof(hdr)))
  473. return -EFAULT;
  474. data += sizeof(hdr);
  475. count -= sizeof(hdr);
  476. if (hdr.nvoices <= 0 || hdr.nvoices >= 100) {
  477. printk(KERN_ERR "Soundfont error: Illegal voice number %d\n",
  478. hdr.nvoices);
  479. return -EINVAL;
  480. }
  481. if (count < (long)sizeof(struct soundfont_voice_info) * hdr.nvoices) {
  482. printk(KERN_ERR "Soundfont Error: "
  483. "patch length(%ld) is smaller than nvoices(%d)\n",
  484. count, hdr.nvoices);
  485. return -EINVAL;
  486. }
  487. switch (hdr.write_mode) {
  488. case SNDRV_SFNT_WR_EXCLUSIVE:
  489. /* exclusive mode - if the instrument already exists,
  490. return error */
  491. for (zone = sf->zones; zone; zone = zone->next) {
  492. if (!zone->mapped &&
  493. zone->bank == hdr.bank &&
  494. zone->instr == hdr.instr)
  495. return -EINVAL;
  496. }
  497. break;
  498. case SNDRV_SFNT_WR_REPLACE:
  499. /* replace mode - remove the instrument if it already exists */
  500. remove_info(sflist, sf, hdr.bank, hdr.instr);
  501. break;
  502. }
  503. for (i = 0; i < hdr.nvoices; i++) {
  504. struct snd_sf_zone tmpzone;
  505. /* copy awe_voice_info parameters */
  506. if (copy_from_user(&tmpzone.v, data, sizeof(tmpzone.v))) {
  507. return -EFAULT;
  508. }
  509. data += sizeof(tmpzone.v);
  510. count -= sizeof(tmpzone.v);
  511. tmpzone.bank = hdr.bank;
  512. tmpzone.instr = hdr.instr;
  513. tmpzone.mapped = 0;
  514. tmpzone.v.sf_id = sf->id;
  515. if (tmpzone.v.mode & SNDRV_SFNT_MODE_INIT_PARM)
  516. init_voice_parm(&tmpzone.v.parm);
  517. /* create a new zone */
  518. if ((zone = sf_zone_new(sflist, sf)) == NULL) {
  519. return -ENOMEM;
  520. }
  521. /* copy the temporary data */
  522. zone->bank = tmpzone.bank;
  523. zone->instr = tmpzone.instr;
  524. zone->v = tmpzone.v;
  525. /* look up the sample */
  526. zone->sample = set_sample(sf, &zone->v);
  527. }
  528. return 0;
  529. }
  530. /* initialize voice_info record */
  531. static void
  532. init_voice_info(struct soundfont_voice_info *avp)
  533. {
  534. memset(avp, 0, sizeof(*avp));
  535. avp->root = 60;
  536. avp->high = 127;
  537. avp->velhigh = 127;
  538. avp->fixkey = -1;
  539. avp->fixvel = -1;
  540. avp->fixpan = -1;
  541. avp->pan = -1;
  542. avp->amplitude = 127;
  543. avp->scaleTuning = 100;
  544. init_voice_parm(&avp->parm);
  545. }
  546. /* initialize voice_parm record:
  547. * Env1/2: delay=0, attack=0, hold=0, sustain=0, decay=0, release=0.
  548. * Vibrato and Tremolo effects are zero.
  549. * Cutoff is maximum.
  550. * Chorus and Reverb effects are zero.
  551. */
  552. static void
  553. init_voice_parm(struct soundfont_voice_parm *pp)
  554. {
  555. memset(pp, 0, sizeof(*pp));
  556. pp->moddelay = 0x8000;
  557. pp->modatkhld = 0x7f7f;
  558. pp->moddcysus = 0x7f7f;
  559. pp->modrelease = 0x807f;
  560. pp->voldelay = 0x8000;
  561. pp->volatkhld = 0x7f7f;
  562. pp->voldcysus = 0x7f7f;
  563. pp->volrelease = 0x807f;
  564. pp->lfo1delay = 0x8000;
  565. pp->lfo2delay = 0x8000;
  566. pp->cutoff = 0xff;
  567. }
  568. /* search the specified sample */
  569. static struct snd_sf_sample *
  570. set_sample(struct snd_soundfont *sf, struct soundfont_voice_info *avp)
  571. {
  572. struct snd_sf_sample *sample;
  573. sample = find_sample(sf, avp->sample);
  574. if (sample == NULL)
  575. return NULL;
  576. /* add in the actual sample offsets:
  577. * The voice_info addresses define only the relative offset
  578. * from sample pointers. Here we calculate the actual DRAM
  579. * offset from sample pointers.
  580. */
  581. avp->start += sample->v.start;
  582. avp->end += sample->v.end;
  583. avp->loopstart += sample->v.loopstart;
  584. avp->loopend += sample->v.loopend;
  585. /* copy mode flags */
  586. avp->sample_mode = sample->v.mode_flags;
  587. return sample;
  588. }
  589. /* find the sample pointer with the given id in the soundfont */
  590. static struct snd_sf_sample *
  591. find_sample(struct snd_soundfont *sf, int sample_id)
  592. {
  593. struct snd_sf_sample *p;
  594. if (sf == NULL)
  595. return NULL;
  596. for (p = sf->samples; p; p = p->next) {
  597. if (p->v.sample == sample_id)
  598. return p;
  599. }
  600. return NULL;
  601. }
  602. /*
  603. * Load sample information, this can include data to be loaded onto
  604. * the soundcard. It can also just be a pointer into soundcard ROM.
  605. * If there is data it will be written to the soundcard via the callback
  606. * routine.
  607. */
  608. static int
  609. load_data(struct snd_sf_list *sflist, const void __user *data, long count)
  610. {
  611. struct snd_soundfont *sf;
  612. struct soundfont_sample_info sample_info;
  613. struct snd_sf_sample *sp;
  614. long off;
  615. /* patch must be opened */
  616. if ((sf = sflist->currsf) == NULL)
  617. return -EINVAL;
  618. if (is_special_type(sf->type))
  619. return -EINVAL;
  620. if (copy_from_user(&sample_info, data, sizeof(sample_info)))
  621. return -EFAULT;
  622. off = sizeof(sample_info);
  623. if (sample_info.size != (count-off)/2)
  624. return -EINVAL;
  625. /* Check for dup */
  626. if (find_sample(sf, sample_info.sample)) {
  627. /* if shared sample, skip this data */
  628. if (sf->type & SNDRV_SFNT_PAT_SHARED)
  629. return 0;
  630. return -EINVAL;
  631. }
  632. /* Allocate a new sample structure */
  633. if ((sp = sf_sample_new(sflist, sf)) == NULL)
  634. return -ENOMEM;
  635. sp->v = sample_info;
  636. sp->v.sf_id = sf->id;
  637. sp->v.dummy = 0;
  638. sp->v.truesize = sp->v.size;
  639. /*
  640. * If there is wave data then load it.
  641. */
  642. if (sp->v.size > 0) {
  643. int rc;
  644. rc = sflist->callback.sample_new
  645. (sflist->callback.private_data, sp, sflist->memhdr,
  646. data + off, count - off);
  647. if (rc < 0) {
  648. sf_sample_delete(sflist, sf, sp);
  649. return rc;
  650. }
  651. sflist->mem_used += sp->v.truesize;
  652. }
  653. return count;
  654. }
  655. /* log2_tbl[i] = log2(i+128) * 0x10000 */
  656. static int log_tbl[129] = {
  657. 0x70000, 0x702df, 0x705b9, 0x7088e, 0x70b5d, 0x70e26, 0x710eb, 0x713aa,
  658. 0x71663, 0x71918, 0x71bc8, 0x71e72, 0x72118, 0x723b9, 0x72655, 0x728ed,
  659. 0x72b80, 0x72e0e, 0x73098, 0x7331d, 0x7359e, 0x7381b, 0x73a93, 0x73d08,
  660. 0x73f78, 0x741e4, 0x7444c, 0x746b0, 0x74910, 0x74b6c, 0x74dc4, 0x75019,
  661. 0x75269, 0x754b6, 0x75700, 0x75946, 0x75b88, 0x75dc7, 0x76002, 0x7623a,
  662. 0x7646e, 0x766a0, 0x768cd, 0x76af8, 0x76d1f, 0x76f43, 0x77164, 0x77382,
  663. 0x7759d, 0x777b4, 0x779c9, 0x77bdb, 0x77dea, 0x77ff5, 0x781fe, 0x78404,
  664. 0x78608, 0x78808, 0x78a06, 0x78c01, 0x78df9, 0x78fef, 0x791e2, 0x793d2,
  665. 0x795c0, 0x797ab, 0x79993, 0x79b79, 0x79d5d, 0x79f3e, 0x7a11d, 0x7a2f9,
  666. 0x7a4d3, 0x7a6ab, 0x7a880, 0x7aa53, 0x7ac24, 0x7adf2, 0x7afbe, 0x7b188,
  667. 0x7b350, 0x7b515, 0x7b6d8, 0x7b899, 0x7ba58, 0x7bc15, 0x7bdd0, 0x7bf89,
  668. 0x7c140, 0x7c2f5, 0x7c4a7, 0x7c658, 0x7c807, 0x7c9b3, 0x7cb5e, 0x7cd07,
  669. 0x7ceae, 0x7d053, 0x7d1f7, 0x7d398, 0x7d538, 0x7d6d6, 0x7d872, 0x7da0c,
  670. 0x7dba4, 0x7dd3b, 0x7ded0, 0x7e063, 0x7e1f4, 0x7e384, 0x7e512, 0x7e69f,
  671. 0x7e829, 0x7e9b3, 0x7eb3a, 0x7ecc0, 0x7ee44, 0x7efc7, 0x7f148, 0x7f2c8,
  672. 0x7f446, 0x7f5c2, 0x7f73d, 0x7f8b7, 0x7fa2f, 0x7fba5, 0x7fd1a, 0x7fe8d,
  673. 0x80000,
  674. };
  675. /* convert from linear to log value
  676. *
  677. * conversion: value = log2(amount / base) * ratio
  678. *
  679. * argument:
  680. * amount = linear value (unsigned, 32bit max)
  681. * offset = base offset (:= log2(base) * 0x10000)
  682. * ratio = division ratio
  683. *
  684. */
  685. int
  686. snd_sf_linear_to_log(unsigned int amount, int offset, int ratio)
  687. {
  688. int v;
  689. int s, low, bit;
  690. if (amount < 2)
  691. return 0;
  692. for (bit = 0; ! (amount & 0x80000000L); bit++)
  693. amount <<= 1;
  694. s = (amount >> 24) & 0x7f;
  695. low = (amount >> 16) & 0xff;
  696. /* linear approxmimation by lower 8 bit */
  697. v = (log_tbl[s + 1] * low + log_tbl[s] * (0x100 - low)) >> 8;
  698. v -= offset;
  699. v = (v * ratio) >> 16;
  700. v += (24 - bit) * ratio;
  701. return v;
  702. }
  703. EXPORT_SYMBOL(snd_sf_linear_to_log);
  704. #define OFFSET_MSEC 653117 /* base = 1000 */
  705. #define OFFSET_ABSCENT 851781 /* base = 8176 */
  706. #define OFFSET_SAMPLERATE 1011119 /* base = 44100 */
  707. #define ABSCENT_RATIO 1200
  708. #define TIMECENT_RATIO 1200
  709. #define SAMPLERATE_RATIO 4096
  710. /*
  711. * mHz to abscent
  712. * conversion: abscent = log2(MHz / 8176) * 1200
  713. */
  714. static int
  715. freq_to_note(int mhz)
  716. {
  717. return snd_sf_linear_to_log(mhz, OFFSET_ABSCENT, ABSCENT_RATIO);
  718. }
  719. /* convert Hz to AWE32 rate offset:
  720. * sample pitch offset for the specified sample rate
  721. * rate=44100 is no offset, each 4096 is 1 octave (twice).
  722. * eg, when rate is 22050, this offset becomes -4096.
  723. *
  724. * conversion: offset = log2(Hz / 44100) * 4096
  725. */
  726. static int
  727. calc_rate_offset(int hz)
  728. {
  729. return snd_sf_linear_to_log(hz, OFFSET_SAMPLERATE, SAMPLERATE_RATIO);
  730. }
  731. /* calculate GUS envelope time */
  732. static int
  733. calc_gus_envelope_time(int rate, int start, int end)
  734. {
  735. int r, p, t;
  736. r = (3 - ((rate >> 6) & 3)) * 3;
  737. p = rate & 0x3f;
  738. t = end - start;
  739. if (t < 0) t = -t;
  740. if (13 > r)
  741. t = t << (13 - r);
  742. else
  743. t = t >> (r - 13);
  744. return (t * 10) / (p * 441);
  745. }
  746. /* convert envelope time parameter to soundfont parameters */
  747. /* attack & decay/release time table (msec) */
  748. static short attack_time_tbl[128] = {
  749. 32767, 32767, 5989, 4235, 2994, 2518, 2117, 1780, 1497, 1373, 1259, 1154, 1058, 970, 890, 816,
  750. 707, 691, 662, 634, 607, 581, 557, 533, 510, 489, 468, 448, 429, 411, 393, 377,
  751. 361, 345, 331, 317, 303, 290, 278, 266, 255, 244, 234, 224, 214, 205, 196, 188,
  752. 180, 172, 165, 158, 151, 145, 139, 133, 127, 122, 117, 112, 107, 102, 98, 94,
  753. 90, 86, 82, 79, 75, 72, 69, 66, 63, 61, 58, 56, 53, 51, 49, 47,
  754. 45, 43, 41, 39, 37, 36, 34, 33, 31, 30, 29, 28, 26, 25, 24, 23,
  755. 22, 21, 20, 19, 19, 18, 17, 16, 16, 15, 15, 14, 13, 13, 12, 12,
  756. 11, 11, 10, 10, 10, 9, 9, 8, 8, 8, 8, 7, 7, 7, 6, 0,
  757. };
  758. static short decay_time_tbl[128] = {
  759. 32767, 32767, 22614, 15990, 11307, 9508, 7995, 6723, 5653, 5184, 4754, 4359, 3997, 3665, 3361, 3082,
  760. 2828, 2765, 2648, 2535, 2428, 2325, 2226, 2132, 2042, 1955, 1872, 1793, 1717, 1644, 1574, 1507,
  761. 1443, 1382, 1324, 1267, 1214, 1162, 1113, 1066, 978, 936, 897, 859, 822, 787, 754, 722,
  762. 691, 662, 634, 607, 581, 557, 533, 510, 489, 468, 448, 429, 411, 393, 377, 361,
  763. 345, 331, 317, 303, 290, 278, 266, 255, 244, 234, 224, 214, 205, 196, 188, 180,
  764. 172, 165, 158, 151, 145, 139, 133, 127, 122, 117, 112, 107, 102, 98, 94, 90,
  765. 86, 82, 79, 75, 72, 69, 66, 63, 61, 58, 56, 53, 51, 49, 47, 45,
  766. 43, 41, 39, 37, 36, 34, 33, 31, 30, 29, 28, 26, 25, 24, 23, 22,
  767. };
  768. /* delay time = 0x8000 - msec/92 */
  769. int
  770. snd_sf_calc_parm_hold(int msec)
  771. {
  772. int val = (0x7f * 92 - msec) / 92;
  773. if (val < 1) val = 1;
  774. if (val >= 126) val = 126;
  775. return val;
  776. }
  777. /* search an index for specified time from given time table */
  778. static int
  779. calc_parm_search(int msec, short *table)
  780. {
  781. int left = 1, right = 127, mid;
  782. while (left < right) {
  783. mid = (left + right) / 2;
  784. if (msec < (int)table[mid])
  785. left = mid + 1;
  786. else
  787. right = mid;
  788. }
  789. return left;
  790. }
  791. /* attack time: search from time table */
  792. int
  793. snd_sf_calc_parm_attack(int msec)
  794. {
  795. return calc_parm_search(msec, attack_time_tbl);
  796. }
  797. /* decay/release time: search from time table */
  798. int
  799. snd_sf_calc_parm_decay(int msec)
  800. {
  801. return calc_parm_search(msec, decay_time_tbl);
  802. }
  803. int snd_sf_vol_table[128] = {
  804. 255,111,95,86,79,74,70,66,63,61,58,56,54,52,50,49,
  805. 47,46,45,43,42,41,40,39,38,37,36,35,34,34,33,32,
  806. 31,31,30,29,29,28,27,27,26,26,25,24,24,23,23,22,
  807. 22,21,21,21,20,20,19,19,18,18,18,17,17,16,16,16,
  808. 15,15,15,14,14,14,13,13,13,12,12,12,11,11,11,10,
  809. 10,10,10,9,9,9,8,8,8,8,7,7,7,7,6,6,
  810. 6,6,5,5,5,5,5,4,4,4,4,3,3,3,3,3,
  811. 2,2,2,2,2,1,1,1,1,1,0,0,0,0,0,0,
  812. };
  813. #define calc_gus_sustain(val) (0x7f - snd_sf_vol_table[(val)/2])
  814. #define calc_gus_attenuation(val) snd_sf_vol_table[(val)/2]
  815. /* load GUS patch */
  816. static int
  817. load_guspatch(struct snd_sf_list *sflist, const char __user *data,
  818. long count, int client)
  819. {
  820. struct patch_info patch;
  821. struct snd_soundfont *sf;
  822. struct snd_sf_zone *zone;
  823. struct snd_sf_sample *smp;
  824. int note, sample_id;
  825. int rc;
  826. if (count < (long)sizeof(patch)) {
  827. snd_printk(KERN_ERR "patch record too small %ld\n", count);
  828. return -EINVAL;
  829. }
  830. if (copy_from_user(&patch, data, sizeof(patch)))
  831. return -EFAULT;
  832. count -= sizeof(patch);
  833. data += sizeof(patch);
  834. sf = newsf(sflist, SNDRV_SFNT_PAT_TYPE_GUS|SNDRV_SFNT_PAT_SHARED, NULL);
  835. if (sf == NULL)
  836. return -ENOMEM;
  837. if ((smp = sf_sample_new(sflist, sf)) == NULL)
  838. return -ENOMEM;
  839. sample_id = sflist->sample_counter;
  840. smp->v.sample = sample_id;
  841. smp->v.start = 0;
  842. smp->v.end = patch.len;
  843. smp->v.loopstart = patch.loop_start;
  844. smp->v.loopend = patch.loop_end;
  845. smp->v.size = patch.len;
  846. /* set up mode flags */
  847. smp->v.mode_flags = 0;
  848. if (!(patch.mode & WAVE_16_BITS))
  849. smp->v.mode_flags |= SNDRV_SFNT_SAMPLE_8BITS;
  850. if (patch.mode & WAVE_UNSIGNED)
  851. smp->v.mode_flags |= SNDRV_SFNT_SAMPLE_UNSIGNED;
  852. smp->v.mode_flags |= SNDRV_SFNT_SAMPLE_NO_BLANK;
  853. if (!(patch.mode & (WAVE_LOOPING|WAVE_BIDIR_LOOP|WAVE_LOOP_BACK)))
  854. smp->v.mode_flags |= SNDRV_SFNT_SAMPLE_SINGLESHOT;
  855. if (patch.mode & WAVE_BIDIR_LOOP)
  856. smp->v.mode_flags |= SNDRV_SFNT_SAMPLE_BIDIR_LOOP;
  857. if (patch.mode & WAVE_LOOP_BACK)
  858. smp->v.mode_flags |= SNDRV_SFNT_SAMPLE_REVERSE_LOOP;
  859. if (patch.mode & WAVE_16_BITS) {
  860. /* convert to word offsets */
  861. smp->v.size /= 2;
  862. smp->v.end /= 2;
  863. smp->v.loopstart /= 2;
  864. smp->v.loopend /= 2;
  865. }
  866. /*smp->v.loopend++;*/
  867. smp->v.dummy = 0;
  868. smp->v.truesize = 0;
  869. smp->v.sf_id = sf->id;
  870. /* set up voice info */
  871. if ((zone = sf_zone_new(sflist, sf)) == NULL) {
  872. sf_sample_delete(sflist, sf, smp);
  873. return -ENOMEM;
  874. }
  875. /*
  876. * load wave data
  877. */
  878. if (sflist->callback.sample_new) {
  879. rc = sflist->callback.sample_new
  880. (sflist->callback.private_data, smp, sflist->memhdr,
  881. data, count);
  882. if (rc < 0) {
  883. sf_sample_delete(sflist, sf, smp);
  884. kfree(zone);
  885. return rc;
  886. }
  887. /* memory offset is updated after */
  888. }
  889. /* update the memory offset here */
  890. sflist->mem_used += smp->v.truesize;
  891. zone->v.sample = sample_id; /* the last sample */
  892. zone->v.rate_offset = calc_rate_offset(patch.base_freq);
  893. note = freq_to_note(patch.base_note);
  894. zone->v.root = note / 100;
  895. zone->v.tune = -(note % 100);
  896. zone->v.low = (freq_to_note(patch.low_note) + 99) / 100;
  897. zone->v.high = freq_to_note(patch.high_note) / 100;
  898. /* panning position; -128 - 127 => 0-127 */
  899. zone->v.pan = (patch.panning + 128) / 2;
  900. #if 0
  901. snd_printk(KERN_DEBUG
  902. "gus: basefrq=%d (ofs=%d) root=%d,tune=%d, range:%d-%d\n",
  903. (int)patch.base_freq, zone->v.rate_offset,
  904. zone->v.root, zone->v.tune, zone->v.low, zone->v.high);
  905. #endif
  906. /* detuning is ignored */
  907. /* 6points volume envelope */
  908. if (patch.mode & WAVE_ENVELOPES) {
  909. int attack, hold, decay, release;
  910. attack = calc_gus_envelope_time
  911. (patch.env_rate[0], 0, patch.env_offset[0]);
  912. hold = calc_gus_envelope_time
  913. (patch.env_rate[1], patch.env_offset[0],
  914. patch.env_offset[1]);
  915. decay = calc_gus_envelope_time
  916. (patch.env_rate[2], patch.env_offset[1],
  917. patch.env_offset[2]);
  918. release = calc_gus_envelope_time
  919. (patch.env_rate[3], patch.env_offset[1],
  920. patch.env_offset[4]);
  921. release += calc_gus_envelope_time
  922. (patch.env_rate[4], patch.env_offset[3],
  923. patch.env_offset[4]);
  924. release += calc_gus_envelope_time
  925. (patch.env_rate[5], patch.env_offset[4],
  926. patch.env_offset[5]);
  927. zone->v.parm.volatkhld =
  928. (snd_sf_calc_parm_hold(hold) << 8) |
  929. snd_sf_calc_parm_attack(attack);
  930. zone->v.parm.voldcysus = (calc_gus_sustain(patch.env_offset[2]) << 8) |
  931. snd_sf_calc_parm_decay(decay);
  932. zone->v.parm.volrelease = 0x8000 | snd_sf_calc_parm_decay(release);
  933. zone->v.attenuation = calc_gus_attenuation(patch.env_offset[0]);
  934. #if 0
  935. snd_printk(KERN_DEBUG
  936. "gus: atkhld=%x, dcysus=%x, volrel=%x, att=%d\n",
  937. zone->v.parm.volatkhld,
  938. zone->v.parm.voldcysus,
  939. zone->v.parm.volrelease,
  940. zone->v.attenuation);
  941. #endif
  942. }
  943. /* fast release */
  944. if (patch.mode & WAVE_FAST_RELEASE) {
  945. zone->v.parm.volrelease = 0x807f;
  946. }
  947. /* tremolo effect */
  948. if (patch.mode & WAVE_TREMOLO) {
  949. int rate = (patch.tremolo_rate * 1000 / 38) / 42;
  950. zone->v.parm.tremfrq = ((patch.tremolo_depth / 2) << 8) | rate;
  951. }
  952. /* vibrato effect */
  953. if (patch.mode & WAVE_VIBRATO) {
  954. int rate = (patch.vibrato_rate * 1000 / 38) / 42;
  955. zone->v.parm.fm2frq2 = ((patch.vibrato_depth / 6) << 8) | rate;
  956. }
  957. /* scale_freq, scale_factor, volume, and fractions not implemented */
  958. if (!(smp->v.mode_flags & SNDRV_SFNT_SAMPLE_SINGLESHOT))
  959. zone->v.mode = SNDRV_SFNT_MODE_LOOPING;
  960. else
  961. zone->v.mode = 0;
  962. /* append to the tail of the list */
  963. /*zone->bank = ctrls[AWE_MD_GUS_BANK];*/
  964. zone->bank = 0;
  965. zone->instr = patch.instr_no;
  966. zone->mapped = 0;
  967. zone->v.sf_id = sf->id;
  968. zone->sample = set_sample(sf, &zone->v);
  969. /* rebuild preset now */
  970. add_preset(sflist, zone);
  971. return 0;
  972. }
  973. /* load GUS patch */
  974. int
  975. snd_soundfont_load_guspatch(struct snd_sf_list *sflist, const char __user *data,
  976. long count, int client)
  977. {
  978. int rc;
  979. lock_preset(sflist);
  980. rc = load_guspatch(sflist, data, count, client);
  981. unlock_preset(sflist);
  982. return rc;
  983. }
  984. /*
  985. * Rebuild the preset table. This is like a hash table in that it allows
  986. * quick access to the zone information. For each preset there are zone
  987. * structures linked by next_instr and by next_zone. Former is the whole
  988. * link for this preset, and latter is the link for zone (i.e. instrument/
  989. * bank/key combination).
  990. */
  991. static void
  992. rebuild_presets(struct snd_sf_list *sflist)
  993. {
  994. struct snd_soundfont *sf;
  995. struct snd_sf_zone *cur;
  996. /* clear preset table */
  997. memset(sflist->presets, 0, sizeof(sflist->presets));
  998. /* search all fonts and insert each font */
  999. for (sf = sflist->fonts; sf; sf = sf->next) {
  1000. for (cur = sf->zones; cur; cur = cur->next) {
  1001. if (! cur->mapped && cur->sample == NULL) {
  1002. /* try again to search the corresponding sample */
  1003. cur->sample = set_sample(sf, &cur->v);
  1004. if (cur->sample == NULL)
  1005. continue;
  1006. }
  1007. add_preset(sflist, cur);
  1008. }
  1009. }
  1010. }
  1011. /*
  1012. * add the given zone to preset table
  1013. */
  1014. static void
  1015. add_preset(struct snd_sf_list *sflist, struct snd_sf_zone *cur)
  1016. {
  1017. struct snd_sf_zone *zone;
  1018. int index;
  1019. zone = search_first_zone(sflist, cur->bank, cur->instr, cur->v.low);
  1020. if (zone && zone->v.sf_id != cur->v.sf_id) {
  1021. /* different instrument was already defined */
  1022. struct snd_sf_zone *p;
  1023. /* compare the allocated time */
  1024. for (p = zone; p; p = p->next_zone) {
  1025. if (p->counter > cur->counter)
  1026. /* the current is older.. skipped */
  1027. return;
  1028. }
  1029. /* remove old zones */
  1030. delete_preset(sflist, zone);
  1031. zone = NULL; /* do not forget to clear this! */
  1032. }
  1033. /* prepend this zone */
  1034. if ((index = get_index(cur->bank, cur->instr, cur->v.low)) < 0)
  1035. return;
  1036. cur->next_zone = zone; /* zone link */
  1037. cur->next_instr = sflist->presets[index]; /* preset table link */
  1038. sflist->presets[index] = cur;
  1039. }
  1040. /*
  1041. * delete the given zones from preset_table
  1042. */
  1043. static void
  1044. delete_preset(struct snd_sf_list *sflist, struct snd_sf_zone *zp)
  1045. {
  1046. int index;
  1047. struct snd_sf_zone *p;
  1048. if ((index = get_index(zp->bank, zp->instr, zp->v.low)) < 0)
  1049. return;
  1050. for (p = sflist->presets[index]; p; p = p->next_instr) {
  1051. while (p->next_instr == zp) {
  1052. p->next_instr = zp->next_instr;
  1053. zp = zp->next_zone;
  1054. if (zp == NULL)
  1055. return;
  1056. }
  1057. }
  1058. }
  1059. /*
  1060. * Search matching zones from preset table.
  1061. * The note can be rewritten by preset mapping (alias).
  1062. * The found zones are stored on 'table' array. max_layers defines
  1063. * the maximum number of elements in this array.
  1064. * This function returns the number of found zones. 0 if not found.
  1065. */
  1066. int
  1067. snd_soundfont_search_zone(struct snd_sf_list *sflist, int *notep, int vel,
  1068. int preset, int bank,
  1069. int def_preset, int def_bank,
  1070. struct snd_sf_zone **table, int max_layers)
  1071. {
  1072. int nvoices;
  1073. unsigned long flags;
  1074. /* this function is supposed to be called atomically,
  1075. * so we check the lock. if it's busy, just returns 0 to
  1076. * tell the caller the busy state
  1077. */
  1078. spin_lock_irqsave(&sflist->lock, flags);
  1079. if (sflist->presets_locked) {
  1080. spin_unlock_irqrestore(&sflist->lock, flags);
  1081. return 0;
  1082. }
  1083. nvoices = search_zones(sflist, notep, vel, preset, bank,
  1084. table, max_layers, 0);
  1085. if (! nvoices) {
  1086. if (preset != def_preset || bank != def_bank)
  1087. nvoices = search_zones(sflist, notep, vel,
  1088. def_preset, def_bank,
  1089. table, max_layers, 0);
  1090. }
  1091. spin_unlock_irqrestore(&sflist->lock, flags);
  1092. return nvoices;
  1093. }
  1094. /*
  1095. * search the first matching zone
  1096. */
  1097. static struct snd_sf_zone *
  1098. search_first_zone(struct snd_sf_list *sflist, int bank, int preset, int key)
  1099. {
  1100. int index;
  1101. struct snd_sf_zone *zp;
  1102. if ((index = get_index(bank, preset, key)) < 0)
  1103. return NULL;
  1104. for (zp = sflist->presets[index]; zp; zp = zp->next_instr) {
  1105. if (zp->instr == preset && zp->bank == bank)
  1106. return zp;
  1107. }
  1108. return NULL;
  1109. }
  1110. /*
  1111. * search matching zones from sflist. can be called recursively.
  1112. */
  1113. static int
  1114. search_zones(struct snd_sf_list *sflist, int *notep, int vel,
  1115. int preset, int bank, struct snd_sf_zone **table,
  1116. int max_layers, int level)
  1117. {
  1118. struct snd_sf_zone *zp;
  1119. int nvoices;
  1120. zp = search_first_zone(sflist, bank, preset, *notep);
  1121. nvoices = 0;
  1122. for (; zp; zp = zp->next_zone) {
  1123. if (*notep >= zp->v.low && *notep <= zp->v.high &&
  1124. vel >= zp->v.vellow && vel <= zp->v.velhigh) {
  1125. if (zp->mapped) {
  1126. /* search preset mapping (aliasing) */
  1127. int key = zp->v.fixkey;
  1128. preset = zp->v.start;
  1129. bank = zp->v.end;
  1130. if (level > 5) /* too deep alias level */
  1131. return 0;
  1132. if (key < 0)
  1133. key = *notep;
  1134. nvoices = search_zones(sflist, &key, vel,
  1135. preset, bank, table,
  1136. max_layers, level + 1);
  1137. if (nvoices > 0)
  1138. *notep = key;
  1139. break;
  1140. }
  1141. table[nvoices++] = zp;
  1142. if (nvoices >= max_layers)
  1143. break;
  1144. }
  1145. }
  1146. return nvoices;
  1147. }
  1148. /* calculate the index of preset table:
  1149. * drums are mapped from 128 to 255 according to its note key.
  1150. * other instruments are mapped from 0 to 127.
  1151. * if the index is out of range, return -1.
  1152. */
  1153. static int
  1154. get_index(int bank, int instr, int key)
  1155. {
  1156. int index;
  1157. if (SF_IS_DRUM_BANK(bank))
  1158. index = key + SF_MAX_INSTRUMENTS;
  1159. else
  1160. index = instr;
  1161. index = index % SF_MAX_PRESETS;
  1162. if (index < 0)
  1163. return -1;
  1164. return index;
  1165. }
  1166. /*
  1167. * Initialise the sflist structure.
  1168. */
  1169. static void
  1170. snd_sf_init(struct snd_sf_list *sflist)
  1171. {
  1172. memset(sflist->presets, 0, sizeof(sflist->presets));
  1173. sflist->mem_used = 0;
  1174. sflist->currsf = NULL;
  1175. sflist->open_client = -1;
  1176. sflist->fonts = NULL;
  1177. sflist->fonts_size = 0;
  1178. sflist->zone_counter = 0;
  1179. sflist->sample_counter = 0;
  1180. sflist->zone_locked = 0;
  1181. sflist->sample_locked = 0;
  1182. }
  1183. /*
  1184. * Release all list records
  1185. */
  1186. static void
  1187. snd_sf_clear(struct snd_sf_list *sflist)
  1188. {
  1189. struct snd_soundfont *sf, *nextsf;
  1190. struct snd_sf_zone *zp, *nextzp;
  1191. struct snd_sf_sample *sp, *nextsp;
  1192. for (sf = sflist->fonts; sf; sf = nextsf) {
  1193. nextsf = sf->next;
  1194. for (zp = sf->zones; zp; zp = nextzp) {
  1195. nextzp = zp->next;
  1196. kfree(zp);
  1197. }
  1198. for (sp = sf->samples; sp; sp = nextsp) {
  1199. nextsp = sp->next;
  1200. if (sflist->callback.sample_free)
  1201. sflist->callback.sample_free(sflist->callback.private_data,
  1202. sp, sflist->memhdr);
  1203. kfree(sp);
  1204. }
  1205. kfree(sf);
  1206. }
  1207. snd_sf_init(sflist);
  1208. }
  1209. /*
  1210. * Create a new sflist structure
  1211. */
  1212. struct snd_sf_list *
  1213. snd_sf_new(struct snd_sf_callback *callback, struct snd_util_memhdr *hdr)
  1214. {
  1215. struct snd_sf_list *sflist;
  1216. if ((sflist = kzalloc(sizeof(*sflist), GFP_KERNEL)) == NULL)
  1217. return NULL;
  1218. mutex_init(&sflist->presets_mutex);
  1219. spin_lock_init(&sflist->lock);
  1220. sflist->memhdr = hdr;
  1221. if (callback)
  1222. sflist->callback = *callback;
  1223. snd_sf_init(sflist);
  1224. return sflist;
  1225. }
  1226. /*
  1227. * Free everything allocated off the sflist structure.
  1228. */
  1229. void
  1230. snd_sf_free(struct snd_sf_list *sflist)
  1231. {
  1232. if (sflist == NULL)
  1233. return;
  1234. lock_preset(sflist);
  1235. if (sflist->callback.sample_reset)
  1236. sflist->callback.sample_reset(sflist->callback.private_data);
  1237. snd_sf_clear(sflist);
  1238. unlock_preset(sflist);
  1239. kfree(sflist);
  1240. }
  1241. /*
  1242. * Remove all samples
  1243. * The soundcard should be silet before calling this function.
  1244. */
  1245. int
  1246. snd_soundfont_remove_samples(struct snd_sf_list *sflist)
  1247. {
  1248. lock_preset(sflist);
  1249. if (sflist->callback.sample_reset)
  1250. sflist->callback.sample_reset(sflist->callback.private_data);
  1251. snd_sf_clear(sflist);
  1252. unlock_preset(sflist);
  1253. return 0;
  1254. }
  1255. /*
  1256. * Remove unlocked samples.
  1257. * The soundcard should be silent before calling this function.
  1258. */
  1259. int
  1260. snd_soundfont_remove_unlocked(struct snd_sf_list *sflist)
  1261. {
  1262. struct snd_soundfont *sf;
  1263. struct snd_sf_zone *zp, *nextzp;
  1264. struct snd_sf_sample *sp, *nextsp;
  1265. lock_preset(sflist);
  1266. if (sflist->callback.sample_reset)
  1267. sflist->callback.sample_reset(sflist->callback.private_data);
  1268. /* to be sure */
  1269. memset(sflist->presets, 0, sizeof(sflist->presets));
  1270. for (sf = sflist->fonts; sf; sf = sf->next) {
  1271. for (zp = sf->zones; zp; zp = nextzp) {
  1272. if (zp->counter < sflist->zone_locked)
  1273. break;
  1274. nextzp = zp->next;
  1275. sf->zones = nextzp;
  1276. kfree(zp);
  1277. }
  1278. for (sp = sf->samples; sp; sp = nextsp) {
  1279. if (sp->counter < sflist->sample_locked)
  1280. break;
  1281. nextsp = sp->next;
  1282. sf->samples = nextsp;
  1283. sflist->mem_used -= sp->v.truesize;
  1284. if (sflist->callback.sample_free)
  1285. sflist->callback.sample_free(sflist->callback.private_data,
  1286. sp, sflist->memhdr);
  1287. kfree(sp);
  1288. }
  1289. }
  1290. sflist->zone_counter = sflist->zone_locked;
  1291. sflist->sample_counter = sflist->sample_locked;
  1292. rebuild_presets(sflist);
  1293. unlock_preset(sflist);
  1294. return 0;
  1295. }