Statistics
| Branch: | Revision:

root / hw / fmopl.c @ 546fa6ab

History | View | Annotate | Download (35 kB)

1
/*
2
**
3
** File: fmopl.c -- software implementation of FM sound generator
4
**
5
** Copyright (C) 1999,2000 Tatsuyuki Satoh , MultiArcadeMachineEmurator development
6
**
7
** Version 0.37a
8
**
9
*/
10

    
11
/*
12
        preliminary :
13
        Problem :
14
        note:
15
*/
16

    
17
/* This version of fmopl.c is a fork of the MAME one, relicensed under the LGPL.
18
 *
19
 * This library is free software; you can redistribute it and/or
20
 * modify it under the terms of the GNU Lesser General Public
21
 * License as published by the Free Software Foundation; either
22
 * version 2.1 of the License, or (at your option) any later version.
23
 *
24
 * This library is distributed in the hope that it will be useful,
25
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
26
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
27
 * Lesser General Public License for more details.
28
 *
29
 * You should have received a copy of the GNU Lesser General Public
30
 * License along with this library; if not, write to the Free Software
31
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
32
 */
33

    
34
#define INLINE                __inline
35
#define HAS_YM3812        1
36

    
37
#include <stdio.h>
38
#include <stdlib.h>
39
#include <string.h>
40
#include <stdarg.h>
41
#include <math.h>
42
//#include "driver.h"                /* use M.A.M.E. */
43
#include "fmopl.h"
44

    
45
#ifndef PI
46
#define PI 3.14159265358979323846
47
#endif
48

    
49
/* -------------------- for debug --------------------- */
50
/* #define OPL_OUTPUT_LOG */
51
#ifdef OPL_OUTPUT_LOG
52
static FILE *opl_dbg_fp = NULL;
53
static FM_OPL *opl_dbg_opl[16];
54
static int opl_dbg_maxchip,opl_dbg_chip;
55
#endif
56

    
57
/* -------------------- preliminary define section --------------------- */
58
/* attack/decay rate time rate */
59
#define OPL_ARRATE     141280  /* RATE 4 =  2826.24ms @ 3.6MHz */
60
#define OPL_DRRATE    1956000  /* RATE 4 = 39280.64ms @ 3.6MHz */
61

    
62
#define DELTAT_MIXING_LEVEL (1) /* DELTA-T ADPCM MIXING LEVEL */
63

    
64
#define FREQ_BITS 24                        /* frequency turn          */
65

    
66
/* counter bits = 20 , octerve 7 */
67
#define FREQ_RATE   (1<<(FREQ_BITS-20))
68
#define TL_BITS    (FREQ_BITS+2)
69

    
70
/* final output shift , limit minimum and maximum */
71
#define OPL_OUTSB   (TL_BITS+3-16)                /* OPL output final shift 16bit */
72
#define OPL_MAXOUT (0x7fff<<OPL_OUTSB)
73
#define OPL_MINOUT (-0x8000<<OPL_OUTSB)
74

    
75
/* -------------------- quality selection --------------------- */
76

    
77
/* sinwave entries */
78
/* used static memory = SIN_ENT * 4 (byte) */
79
#define SIN_ENT 2048
80

    
81
/* output level entries (envelope,sinwave) */
82
/* envelope counter lower bits */
83
#define ENV_BITS 16
84
/* envelope output entries */
85
#define EG_ENT   4096
86
/* used dynamic memory = EG_ENT*4*4(byte)or EG_ENT*6*4(byte) */
87
/* used static  memory = EG_ENT*4 (byte)                     */
88

    
89
#define EG_OFF   ((2*EG_ENT)<<ENV_BITS)  /* OFF          */
90
#define EG_DED   EG_OFF
91
#define EG_DST   (EG_ENT<<ENV_BITS)      /* DECAY  START */
92
#define EG_AED   EG_DST
93
#define EG_AST   0                       /* ATTACK START */
94

    
95
#define EG_STEP (96.0/EG_ENT) /* OPL is 0.1875 dB step  */
96

    
97
/* LFO table entries */
98
#define VIB_ENT 512
99
#define VIB_SHIFT (32-9)
100
#define AMS_ENT 512
101
#define AMS_SHIFT (32-9)
102

    
103
#define VIB_RATE 256
104

    
105
/* -------------------- local defines , macros --------------------- */
106

    
107
/* register number to channel number , slot offset */
108
#define SLOT1 0
109
#define SLOT2 1
110

    
111
/* envelope phase */
112
#define ENV_MOD_RR  0x00
113
#define ENV_MOD_DR  0x01
114
#define ENV_MOD_AR  0x02
115

    
116
/* -------------------- tables --------------------- */
117
static const int slot_array[32]=
118
{
119
         0, 2, 4, 1, 3, 5,-1,-1,
120
         6, 8,10, 7, 9,11,-1,-1,
121
        12,14,16,13,15,17,-1,-1,
122
        -1,-1,-1,-1,-1,-1,-1,-1
123
};
124

    
125
/* key scale level */
126
/* table is 3dB/OCT , DV converts this in TL step at 6dB/OCT */
127
#define DV (EG_STEP/2)
128
static const UINT32 KSL_TABLE[8*16]=
129
{
130
        /* OCT 0 */
131
         0.000/DV, 0.000/DV, 0.000/DV, 0.000/DV,
132
         0.000/DV, 0.000/DV, 0.000/DV, 0.000/DV,
133
         0.000/DV, 0.000/DV, 0.000/DV, 0.000/DV,
134
         0.000/DV, 0.000/DV, 0.000/DV, 0.000/DV,
135
        /* OCT 1 */
136
         0.000/DV, 0.000/DV, 0.000/DV, 0.000/DV,
137
         0.000/DV, 0.000/DV, 0.000/DV, 0.000/DV,
138
         0.000/DV, 0.750/DV, 1.125/DV, 1.500/DV,
139
         1.875/DV, 2.250/DV, 2.625/DV, 3.000/DV,
140
        /* OCT 2 */
141
         0.000/DV, 0.000/DV, 0.000/DV, 0.000/DV,
142
         0.000/DV, 1.125/DV, 1.875/DV, 2.625/DV,
143
         3.000/DV, 3.750/DV, 4.125/DV, 4.500/DV,
144
         4.875/DV, 5.250/DV, 5.625/DV, 6.000/DV,
145
        /* OCT 3 */
146
         0.000/DV, 0.000/DV, 0.000/DV, 1.875/DV,
147
         3.000/DV, 4.125/DV, 4.875/DV, 5.625/DV,
148
         6.000/DV, 6.750/DV, 7.125/DV, 7.500/DV,
149
         7.875/DV, 8.250/DV, 8.625/DV, 9.000/DV,
150
        /* OCT 4 */
151
         0.000/DV, 0.000/DV, 3.000/DV, 4.875/DV,
152
         6.000/DV, 7.125/DV, 7.875/DV, 8.625/DV,
153
         9.000/DV, 9.750/DV,10.125/DV,10.500/DV,
154
        10.875/DV,11.250/DV,11.625/DV,12.000/DV,
155
        /* OCT 5 */
156
         0.000/DV, 3.000/DV, 6.000/DV, 7.875/DV,
157
         9.000/DV,10.125/DV,10.875/DV,11.625/DV,
158
        12.000/DV,12.750/DV,13.125/DV,13.500/DV,
159
        13.875/DV,14.250/DV,14.625/DV,15.000/DV,
160
        /* OCT 6 */
161
         0.000/DV, 6.000/DV, 9.000/DV,10.875/DV,
162
        12.000/DV,13.125/DV,13.875/DV,14.625/DV,
163
        15.000/DV,15.750/DV,16.125/DV,16.500/DV,
164
        16.875/DV,17.250/DV,17.625/DV,18.000/DV,
165
        /* OCT 7 */
166
         0.000/DV, 9.000/DV,12.000/DV,13.875/DV,
167
        15.000/DV,16.125/DV,16.875/DV,17.625/DV,
168
        18.000/DV,18.750/DV,19.125/DV,19.500/DV,
169
        19.875/DV,20.250/DV,20.625/DV,21.000/DV
170
};
171
#undef DV
172

    
173
/* sustain lebel table (3db per step) */
174
/* 0 - 15: 0, 3, 6, 9,12,15,18,21,24,27,30,33,36,39,42,93 (dB)*/
175
#define SC(db) (db*((3/EG_STEP)*(1<<ENV_BITS)))+EG_DST
176
static const INT32 SL_TABLE[16]={
177
 SC( 0),SC( 1),SC( 2),SC(3 ),SC(4 ),SC(5 ),SC(6 ),SC( 7),
178
 SC( 8),SC( 9),SC(10),SC(11),SC(12),SC(13),SC(14),SC(31)
179
};
180
#undef SC
181

    
182
#define TL_MAX (EG_ENT*2) /* limit(tl + ksr + envelope) + sinwave */
183
/* TotalLevel : 48 24 12  6  3 1.5 0.75 (dB) */
184
/* TL_TABLE[ 0      to TL_MAX          ] : plus  section */
185
/* TL_TABLE[ TL_MAX to TL_MAX+TL_MAX-1 ] : minus section */
186
static INT32 *TL_TABLE;
187

    
188
/* pointers to TL_TABLE with sinwave output offset */
189
static INT32 **SIN_TABLE;
190

    
191
/* LFO table */
192
static INT32 *AMS_TABLE;
193
static INT32 *VIB_TABLE;
194

    
195
/* envelope output curve table */
196
/* attack + decay + OFF */
197
static INT32 ENV_CURVE[2*EG_ENT+1];
198

    
199
/* multiple table */
200
#define ML 2
201
static const UINT32 MUL_TABLE[16]= {
202
/* 1/2, 1, 2, 3, 4, 5, 6, 7, 8, 9,10,11,12,13,14,15 */
203
   0.50*ML, 1.00*ML, 2.00*ML, 3.00*ML, 4.00*ML, 5.00*ML, 6.00*ML, 7.00*ML,
204
   8.00*ML, 9.00*ML,10.00*ML,10.00*ML,12.00*ML,12.00*ML,15.00*ML,15.00*ML
205
};
206
#undef ML
207

    
208
/* dummy attack / decay rate ( when rate == 0 ) */
209
static INT32 RATE_0[16]=
210
{0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};
211

    
212
/* -------------------- static state --------------------- */
213

    
214
/* lock level of common table */
215
static int num_lock = 0;
216

    
217
/* work table */
218
static void *cur_chip = NULL;        /* current chip point */
219
/* currenct chip state */
220
/* static OPLSAMPLE  *bufL,*bufR; */
221
static OPL_CH *S_CH;
222
static OPL_CH *E_CH;
223
OPL_SLOT *SLOT7_1,*SLOT7_2,*SLOT8_1,*SLOT8_2;
224

    
225
static INT32 outd[1];
226
static INT32 ams;
227
static INT32 vib;
228
INT32  *ams_table;
229
INT32  *vib_table;
230
static INT32 amsIncr;
231
static INT32 vibIncr;
232
static INT32 feedback2;                /* connect for SLOT 2 */
233

    
234
/* log output level */
235
#define LOG_ERR  3      /* ERROR       */
236
#define LOG_WAR  2      /* WARNING     */
237
#define LOG_INF  1      /* INFORMATION */
238

    
239
//#define LOG_LEVEL LOG_INF
240
#define LOG_LEVEL        LOG_ERR
241

    
242
//#define LOG(n,x) if( (n)>=LOG_LEVEL ) logerror x
243
#define LOG(n,x)
244

    
245
/* --------------------- subroutines  --------------------- */
246

    
247
INLINE int Limit( int val, int max, int min ) {
248
        if ( val > max )
249
                val = max;
250
        else if ( val < min )
251
                val = min;
252

    
253
        return val;
254
}
255

    
256
/* status set and IRQ handling */
257
INLINE void OPL_STATUS_SET(FM_OPL *OPL,int flag)
258
{
259
        /* set status flag */
260
        OPL->status |= flag;
261
        if(!(OPL->status & 0x80))
262
        {
263
                if(OPL->status & OPL->statusmask)
264
                {        /* IRQ on */
265
                        OPL->status |= 0x80;
266
                        /* callback user interrupt handler (IRQ is OFF to ON) */
267
                        if(OPL->IRQHandler) (OPL->IRQHandler)(OPL->IRQParam,1);
268
                }
269
        }
270
}
271

    
272
/* status reset and IRQ handling */
273
INLINE void OPL_STATUS_RESET(FM_OPL *OPL,int flag)
274
{
275
        /* reset status flag */
276
        OPL->status &=~flag;
277
        if((OPL->status & 0x80))
278
        {
279
                if (!(OPL->status & OPL->statusmask) )
280
                {
281
                        OPL->status &= 0x7f;
282
                        /* callback user interrupt handler (IRQ is ON to OFF) */
283
                        if(OPL->IRQHandler) (OPL->IRQHandler)(OPL->IRQParam,0);
284
                }
285
        }
286
}
287

    
288
/* IRQ mask set */
289
INLINE void OPL_STATUSMASK_SET(FM_OPL *OPL,int flag)
290
{
291
        OPL->statusmask = flag;
292
        /* IRQ handling check */
293
        OPL_STATUS_SET(OPL,0);
294
        OPL_STATUS_RESET(OPL,0);
295
}
296

    
297
/* ----- key on  ----- */
298
INLINE void OPL_KEYON(OPL_SLOT *SLOT)
299
{
300
        /* sin wave restart */
301
        SLOT->Cnt = 0;
302
        /* set attack */
303
        SLOT->evm = ENV_MOD_AR;
304
        SLOT->evs = SLOT->evsa;
305
        SLOT->evc = EG_AST;
306
        SLOT->eve = EG_AED;
307
}
308
/* ----- key off ----- */
309
INLINE void OPL_KEYOFF(OPL_SLOT *SLOT)
310
{
311
        if( SLOT->evm > ENV_MOD_RR)
312
        {
313
                /* set envelope counter from envleope output */
314
                SLOT->evm = ENV_MOD_RR;
315
                if( !(SLOT->evc&EG_DST) )
316
                        //SLOT->evc = (ENV_CURVE[SLOT->evc>>ENV_BITS]<<ENV_BITS) + EG_DST;
317
                        SLOT->evc = EG_DST;
318
                SLOT->eve = EG_DED;
319
                SLOT->evs = SLOT->evsr;
320
        }
321
}
322

    
323
/* ---------- calcrate Envelope Generator & Phase Generator ---------- */
324
/* return : envelope output */
325
INLINE UINT32 OPL_CALC_SLOT( OPL_SLOT *SLOT )
326
{
327
        /* calcrate envelope generator */
328
        if( (SLOT->evc+=SLOT->evs) >= SLOT->eve )
329
        {
330
                switch( SLOT->evm ){
331
                case ENV_MOD_AR: /* ATTACK -> DECAY1 */
332
                        /* next DR */
333
                        SLOT->evm = ENV_MOD_DR;
334
                        SLOT->evc = EG_DST;
335
                        SLOT->eve = SLOT->SL;
336
                        SLOT->evs = SLOT->evsd;
337
                        break;
338
                case ENV_MOD_DR: /* DECAY -> SL or RR */
339
                        SLOT->evc = SLOT->SL;
340
                        SLOT->eve = EG_DED;
341
                        if(SLOT->eg_typ)
342
                        {
343
                                SLOT->evs = 0;
344
                        }
345
                        else
346
                        {
347
                                SLOT->evm = ENV_MOD_RR;
348
                                SLOT->evs = SLOT->evsr;
349
                        }
350
                        break;
351
                case ENV_MOD_RR: /* RR -> OFF */
352
                        SLOT->evc = EG_OFF;
353
                        SLOT->eve = EG_OFF+1;
354
                        SLOT->evs = 0;
355
                        break;
356
                }
357
        }
358
        /* calcrate envelope */
359
        return SLOT->TLL+ENV_CURVE[SLOT->evc>>ENV_BITS]+(SLOT->ams ? ams : 0);
360
}
361

    
362
/* set algorythm connection */
363
static void set_algorythm( OPL_CH *CH)
364
{
365
        INT32 *carrier = &outd[0];
366
        CH->connect1 = CH->CON ? carrier : &feedback2;
367
        CH->connect2 = carrier;
368
}
369

    
370
/* ---------- frequency counter for operater update ---------- */
371
INLINE void CALC_FCSLOT(OPL_CH *CH,OPL_SLOT *SLOT)
372
{
373
        int ksr;
374

    
375
        /* frequency step counter */
376
        SLOT->Incr = CH->fc * SLOT->mul;
377
        ksr = CH->kcode >> SLOT->KSR;
378

    
379
        if( SLOT->ksr != ksr )
380
        {
381
                SLOT->ksr = ksr;
382
                /* attack , decay rate recalcration */
383
                SLOT->evsa = SLOT->AR[ksr];
384
                SLOT->evsd = SLOT->DR[ksr];
385
                SLOT->evsr = SLOT->RR[ksr];
386
        }
387
        SLOT->TLL = SLOT->TL + (CH->ksl_base>>SLOT->ksl);
388
}
389

    
390
/* set multi,am,vib,EG-TYP,KSR,mul */
391
INLINE void set_mul(FM_OPL *OPL,int slot,int v)
392
{
393
        OPL_CH   *CH   = &OPL->P_CH[slot/2];
394
        OPL_SLOT *SLOT = &CH->SLOT[slot&1];
395

    
396
        SLOT->mul    = MUL_TABLE[v&0x0f];
397
        SLOT->KSR    = (v&0x10) ? 0 : 2;
398
        SLOT->eg_typ = (v&0x20)>>5;
399
        SLOT->vib    = (v&0x40);
400
        SLOT->ams    = (v&0x80);
401
        CALC_FCSLOT(CH,SLOT);
402
}
403

    
404
/* set ksl & tl */
405
INLINE void set_ksl_tl(FM_OPL *OPL,int slot,int v)
406
{
407
        OPL_CH   *CH   = &OPL->P_CH[slot/2];
408
        OPL_SLOT *SLOT = &CH->SLOT[slot&1];
409
        int ksl = v>>6; /* 0 / 1.5 / 3 / 6 db/OCT */
410

    
411
        SLOT->ksl = ksl ? 3-ksl : 31;
412
        SLOT->TL  = (v&0x3f)*(0.75/EG_STEP); /* 0.75db step */
413

    
414
        if( !(OPL->mode&0x80) )
415
        {        /* not CSM latch total level */
416
                SLOT->TLL = SLOT->TL + (CH->ksl_base>>SLOT->ksl);
417
        }
418
}
419

    
420
/* set attack rate & decay rate  */
421
INLINE void set_ar_dr(FM_OPL *OPL,int slot,int v)
422
{
423
        OPL_CH   *CH   = &OPL->P_CH[slot/2];
424
        OPL_SLOT *SLOT = &CH->SLOT[slot&1];
425
        int ar = v>>4;
426
        int dr = v&0x0f;
427

    
428
        SLOT->AR = ar ? &OPL->AR_TABLE[ar<<2] : RATE_0;
429
        SLOT->evsa = SLOT->AR[SLOT->ksr];
430
        if( SLOT->evm == ENV_MOD_AR ) SLOT->evs = SLOT->evsa;
431

    
432
        SLOT->DR = dr ? &OPL->DR_TABLE[dr<<2] : RATE_0;
433
        SLOT->evsd = SLOT->DR[SLOT->ksr];
434
        if( SLOT->evm == ENV_MOD_DR ) SLOT->evs = SLOT->evsd;
435
}
436

    
437
/* set sustain level & release rate */
438
INLINE void set_sl_rr(FM_OPL *OPL,int slot,int v)
439
{
440
        OPL_CH   *CH   = &OPL->P_CH[slot/2];
441
        OPL_SLOT *SLOT = &CH->SLOT[slot&1];
442
        int sl = v>>4;
443
        int rr = v & 0x0f;
444

    
445
        SLOT->SL = SL_TABLE[sl];
446
        if( SLOT->evm == ENV_MOD_DR ) SLOT->eve = SLOT->SL;
447
        SLOT->RR = &OPL->DR_TABLE[rr<<2];
448
        SLOT->evsr = SLOT->RR[SLOT->ksr];
449
        if( SLOT->evm == ENV_MOD_RR ) SLOT->evs = SLOT->evsr;
450
}
451

    
452
/* operator output calcrator */
453
#define OP_OUT(slot,env,con)   slot->wavetable[((slot->Cnt+con)/(0x1000000/SIN_ENT))&(SIN_ENT-1)][env]
454
/* ---------- calcrate one of channel ---------- */
455
INLINE void OPL_CALC_CH( OPL_CH *CH )
456
{
457
        UINT32 env_out;
458
        OPL_SLOT *SLOT;
459

    
460
        feedback2 = 0;
461
        /* SLOT 1 */
462
        SLOT = &CH->SLOT[SLOT1];
463
        env_out=OPL_CALC_SLOT(SLOT);
464
        if( env_out < EG_ENT-1 )
465
        {
466
                /* PG */
467
                if(SLOT->vib) SLOT->Cnt += (SLOT->Incr*vib/VIB_RATE);
468
                else          SLOT->Cnt += SLOT->Incr;
469
                /* connectoion */
470
                if(CH->FB)
471
                {
472
                        int feedback1 = (CH->op1_out[0]+CH->op1_out[1])>>CH->FB;
473
                        CH->op1_out[1] = CH->op1_out[0];
474
                        *CH->connect1 += CH->op1_out[0] = OP_OUT(SLOT,env_out,feedback1);
475
                }
476
                else
477
                {
478
                        *CH->connect1 += OP_OUT(SLOT,env_out,0);
479
                }
480
        }else
481
        {
482
                CH->op1_out[1] = CH->op1_out[0];
483
                CH->op1_out[0] = 0;
484
        }
485
        /* SLOT 2 */
486
        SLOT = &CH->SLOT[SLOT2];
487
        env_out=OPL_CALC_SLOT(SLOT);
488
        if( env_out < EG_ENT-1 )
489
        {
490
                /* PG */
491
                if(SLOT->vib) SLOT->Cnt += (SLOT->Incr*vib/VIB_RATE);
492
                else          SLOT->Cnt += SLOT->Incr;
493
                /* connectoion */
494
                outd[0] += OP_OUT(SLOT,env_out, feedback2);
495
        }
496
}
497

    
498
/* ---------- calcrate rythm block ---------- */
499
#define WHITE_NOISE_db 6.0
500
INLINE void OPL_CALC_RH( OPL_CH *CH )
501
{
502
        UINT32 env_tam,env_sd,env_top,env_hh;
503
        int whitenoise = (rand()&1)*(WHITE_NOISE_db/EG_STEP);
504
        INT32 tone8;
505

    
506
        OPL_SLOT *SLOT;
507
        int env_out;
508

    
509
        /* BD : same as FM serial mode and output level is large */
510
        feedback2 = 0;
511
        /* SLOT 1 */
512
        SLOT = &CH[6].SLOT[SLOT1];
513
        env_out=OPL_CALC_SLOT(SLOT);
514
        if( env_out < EG_ENT-1 )
515
        {
516
                /* PG */
517
                if(SLOT->vib) SLOT->Cnt += (SLOT->Incr*vib/VIB_RATE);
518
                else          SLOT->Cnt += SLOT->Incr;
519
                /* connectoion */
520
                if(CH[6].FB)
521
                {
522
                        int feedback1 = (CH[6].op1_out[0]+CH[6].op1_out[1])>>CH[6].FB;
523
                        CH[6].op1_out[1] = CH[6].op1_out[0];
524
                        feedback2 = CH[6].op1_out[0] = OP_OUT(SLOT,env_out,feedback1);
525
                }
526
                else
527
                {
528
                        feedback2 = OP_OUT(SLOT,env_out,0);
529
                }
530
        }else
531
        {
532
                feedback2 = 0;
533
                CH[6].op1_out[1] = CH[6].op1_out[0];
534
                CH[6].op1_out[0] = 0;
535
        }
536
        /* SLOT 2 */
537
        SLOT = &CH[6].SLOT[SLOT2];
538
        env_out=OPL_CALC_SLOT(SLOT);
539
        if( env_out < EG_ENT-1 )
540
        {
541
                /* PG */
542
                if(SLOT->vib) SLOT->Cnt += (SLOT->Incr*vib/VIB_RATE);
543
                else          SLOT->Cnt += SLOT->Incr;
544
                /* connectoion */
545
                outd[0] += OP_OUT(SLOT,env_out, feedback2)*2;
546
        }
547

    
548
        // SD  (17) = mul14[fnum7] + white noise
549
        // TAM (15) = mul15[fnum8]
550
        // TOP (18) = fnum6(mul18[fnum8]+whitenoise)
551
        // HH  (14) = fnum7(mul18[fnum8]+whitenoise) + white noise
552
        env_sd =OPL_CALC_SLOT(SLOT7_2) + whitenoise;
553
        env_tam=OPL_CALC_SLOT(SLOT8_1);
554
        env_top=OPL_CALC_SLOT(SLOT8_2);
555
        env_hh =OPL_CALC_SLOT(SLOT7_1) + whitenoise;
556

    
557
        /* PG */
558
        if(SLOT7_1->vib) SLOT7_1->Cnt += (2*SLOT7_1->Incr*vib/VIB_RATE);
559
        else             SLOT7_1->Cnt += 2*SLOT7_1->Incr;
560
        if(SLOT7_2->vib) SLOT7_2->Cnt += ((CH[7].fc*8)*vib/VIB_RATE);
561
        else             SLOT7_2->Cnt += (CH[7].fc*8);
562
        if(SLOT8_1->vib) SLOT8_1->Cnt += (SLOT8_1->Incr*vib/VIB_RATE);
563
        else             SLOT8_1->Cnt += SLOT8_1->Incr;
564
        if(SLOT8_2->vib) SLOT8_2->Cnt += ((CH[8].fc*48)*vib/VIB_RATE);
565
        else             SLOT8_2->Cnt += (CH[8].fc*48);
566

    
567
        tone8 = OP_OUT(SLOT8_2,whitenoise,0 );
568

    
569
        /* SD */
570
        if( env_sd < EG_ENT-1 )
571
                outd[0] += OP_OUT(SLOT7_1,env_sd, 0)*8;
572
        /* TAM */
573
        if( env_tam < EG_ENT-1 )
574
                outd[0] += OP_OUT(SLOT8_1,env_tam, 0)*2;
575
        /* TOP-CY */
576
        if( env_top < EG_ENT-1 )
577
                outd[0] += OP_OUT(SLOT7_2,env_top,tone8)*2;
578
        /* HH */
579
        if( env_hh  < EG_ENT-1 )
580
                outd[0] += OP_OUT(SLOT7_2,env_hh,tone8)*2;
581
}
582

    
583
/* ----------- initialize time tabls ----------- */
584
static void init_timetables( FM_OPL *OPL , int ARRATE , int DRRATE )
585
{
586
        int i;
587
        double rate;
588

    
589
        /* make attack rate & decay rate tables */
590
        for (i = 0;i < 4;i++) OPL->AR_TABLE[i] = OPL->DR_TABLE[i] = 0;
591
        for (i = 4;i <= 60;i++){
592
                rate  = OPL->freqbase;                                                /* frequency rate */
593
                if( i < 60 ) rate *= 1.0+(i&3)*0.25;                /* b0-1 : x1 , x1.25 , x1.5 , x1.75 */
594
                rate *= 1<<((i>>2)-1);                                                /* b2-5 : shift bit */
595
                rate *= (double)(EG_ENT<<ENV_BITS);
596
                OPL->AR_TABLE[i] = rate / ARRATE;
597
                OPL->DR_TABLE[i] = rate / DRRATE;
598
        }
599
        for (i = 60;i < 76;i++)
600
        {
601
                OPL->AR_TABLE[i] = EG_AED-1;
602
                OPL->DR_TABLE[i] = OPL->DR_TABLE[60];
603
        }
604
#if 0
605
        for (i = 0;i < 64 ;i++){        /* make for overflow area */
606
                LOG(LOG_WAR,("rate %2d , ar %f ms , dr %f ms \n",i,
607
                        ((double)(EG_ENT<<ENV_BITS) / OPL->AR_TABLE[i]) * (1000.0 / OPL->rate),
608
                        ((double)(EG_ENT<<ENV_BITS) / OPL->DR_TABLE[i]) * (1000.0 / OPL->rate) ));
609
        }
610
#endif
611
}
612

    
613
/* ---------- generic table initialize ---------- */
614
static int OPLOpenTable( void )
615
{
616
        int s,t;
617
        double rate;
618
        int i,j;
619
        double pom;
620

    
621
        /* allocate dynamic tables */
622
        if( (TL_TABLE = malloc(TL_MAX*2*sizeof(INT32))) == NULL)
623
                return 0;
624
        if( (SIN_TABLE = malloc(SIN_ENT*4 *sizeof(INT32 *))) == NULL)
625
        {
626
                free(TL_TABLE);
627
                return 0;
628
        }
629
        if( (AMS_TABLE = malloc(AMS_ENT*2 *sizeof(INT32))) == NULL)
630
        {
631
                free(TL_TABLE);
632
                free(SIN_TABLE);
633
                return 0;
634
        }
635
        if( (VIB_TABLE = malloc(VIB_ENT*2 *sizeof(INT32))) == NULL)
636
        {
637
                free(TL_TABLE);
638
                free(SIN_TABLE);
639
                free(AMS_TABLE);
640
                return 0;
641
        }
642
        /* make total level table */
643
        for (t = 0;t < EG_ENT-1 ;t++){
644
                rate = ((1<<TL_BITS)-1)/pow(10,EG_STEP*t/20);        /* dB -> voltage */
645
                TL_TABLE[       t] =  (int)rate;
646
                TL_TABLE[TL_MAX+t] = -TL_TABLE[t];
647
/*                LOG(LOG_INF,("TotalLevel(%3d) = %x\n",t,TL_TABLE[t]));*/
648
        }
649
        /* fill volume off area */
650
        for ( t = EG_ENT-1; t < TL_MAX ;t++){
651
                TL_TABLE[t] = TL_TABLE[TL_MAX+t] = 0;
652
        }
653

    
654
        /* make sinwave table (total level offet) */
655
        /* degree 0 = degree 180                   = off */
656
        SIN_TABLE[0] = SIN_TABLE[SIN_ENT/2]         = &TL_TABLE[EG_ENT-1];
657
        for (s = 1;s <= SIN_ENT/4;s++){
658
                pom = sin(2*PI*s/SIN_ENT); /* sin     */
659
                pom = 20*log10(1/pom);           /* decibel */
660
                j = pom / EG_STEP;         /* TL_TABLE steps */
661

    
662
        /* degree 0   -  90    , degree 180 -  90 : plus section */
663
                SIN_TABLE[          s] = SIN_TABLE[SIN_ENT/2-s] = &TL_TABLE[j];
664
        /* degree 180 - 270    , degree 360 - 270 : minus section */
665
                SIN_TABLE[SIN_ENT/2+s] = SIN_TABLE[SIN_ENT  -s] = &TL_TABLE[TL_MAX+j];
666
/*                LOG(LOG_INF,("sin(%3d) = %f:%f db\n",s,pom,(double)j * EG_STEP));*/
667
        }
668
        for (s = 0;s < SIN_ENT;s++)
669
        {
670
                SIN_TABLE[SIN_ENT*1+s] = s<(SIN_ENT/2) ? SIN_TABLE[s] : &TL_TABLE[EG_ENT];
671
                SIN_TABLE[SIN_ENT*2+s] = SIN_TABLE[s % (SIN_ENT/2)];
672
                SIN_TABLE[SIN_ENT*3+s] = (s/(SIN_ENT/4))&1 ? &TL_TABLE[EG_ENT] : SIN_TABLE[SIN_ENT*2+s];
673
        }
674

    
675
        /* envelope counter -> envelope output table */
676
        for (i=0; i<EG_ENT; i++)
677
        {
678
                /* ATTACK curve */
679
                pom = pow( ((double)(EG_ENT-1-i)/EG_ENT) , 8 ) * EG_ENT;
680
                /* if( pom >= EG_ENT ) pom = EG_ENT-1; */
681
                ENV_CURVE[i] = (int)pom;
682
                /* DECAY ,RELEASE curve */
683
                ENV_CURVE[(EG_DST>>ENV_BITS)+i]= i;
684
        }
685
        /* off */
686
        ENV_CURVE[EG_OFF>>ENV_BITS]= EG_ENT-1;
687
        /* make LFO ams table */
688
        for (i=0; i<AMS_ENT; i++)
689
        {
690
                pom = (1.0+sin(2*PI*i/AMS_ENT))/2; /* sin */
691
                AMS_TABLE[i]         = (1.0/EG_STEP)*pom; /* 1dB   */
692
                AMS_TABLE[AMS_ENT+i] = (4.8/EG_STEP)*pom; /* 4.8dB */
693
        }
694
        /* make LFO vibrate table */
695
        for (i=0; i<VIB_ENT; i++)
696
        {
697
                /* 100cent = 1seminote = 6% ?? */
698
                pom = (double)VIB_RATE*0.06*sin(2*PI*i/VIB_ENT); /* +-100sect step */
699
                VIB_TABLE[i]         = VIB_RATE + (pom*0.07); /* +- 7cent */
700
                VIB_TABLE[VIB_ENT+i] = VIB_RATE + (pom*0.14); /* +-14cent */
701
                /* LOG(LOG_INF,("vib %d=%d\n",i,VIB_TABLE[VIB_ENT+i])); */
702
        }
703
        return 1;
704
}
705

    
706

    
707
static void OPLCloseTable( void )
708
{
709
        free(TL_TABLE);
710
        free(SIN_TABLE);
711
        free(AMS_TABLE);
712
        free(VIB_TABLE);
713
}
714

    
715
/* CSM Key Controll */
716
INLINE void CSMKeyControll(OPL_CH *CH)
717
{
718
        OPL_SLOT *slot1 = &CH->SLOT[SLOT1];
719
        OPL_SLOT *slot2 = &CH->SLOT[SLOT2];
720
        /* all key off */
721
        OPL_KEYOFF(slot1);
722
        OPL_KEYOFF(slot2);
723
        /* total level latch */
724
        slot1->TLL = slot1->TL + (CH->ksl_base>>slot1->ksl);
725
        slot1->TLL = slot1->TL + (CH->ksl_base>>slot1->ksl);
726
        /* key on */
727
        CH->op1_out[0] = CH->op1_out[1] = 0;
728
        OPL_KEYON(slot1);
729
        OPL_KEYON(slot2);
730
}
731

    
732
/* ---------- opl initialize ---------- */
733
static void OPL_initalize(FM_OPL *OPL)
734
{
735
        int fn;
736

    
737
        /* frequency base */
738
        OPL->freqbase = (OPL->rate) ? ((double)OPL->clock / OPL->rate) / 72  : 0;
739
        /* Timer base time */
740
        OPL->TimerBase = 1.0/((double)OPL->clock / 72.0 );
741
        /* make time tables */
742
        init_timetables( OPL , OPL_ARRATE , OPL_DRRATE );
743
        /* make fnumber -> increment counter table */
744
        for( fn=0 ; fn < 1024 ; fn++ )
745
        {
746
                OPL->FN_TABLE[fn] = OPL->freqbase * fn * FREQ_RATE * (1<<7) / 2;
747
        }
748
        /* LFO freq.table */
749
        OPL->amsIncr = OPL->rate ? (double)AMS_ENT*(1<<AMS_SHIFT) / OPL->rate * 3.7 * ((double)OPL->clock/3600000) : 0;
750
        OPL->vibIncr = OPL->rate ? (double)VIB_ENT*(1<<VIB_SHIFT) / OPL->rate * 6.4 * ((double)OPL->clock/3600000) : 0;
751
}
752

    
753
/* ---------- write a OPL registers ---------- */
754
static void OPLWriteReg(FM_OPL *OPL, int r, int v)
755
{
756
        OPL_CH *CH;
757
        int slot;
758
        int block_fnum;
759

    
760
        switch(r&0xe0)
761
        {
762
        case 0x00: /* 00-1f:controll */
763
                switch(r&0x1f)
764
                {
765
                case 0x01:
766
                        /* wave selector enable */
767
                        if(OPL->type&OPL_TYPE_WAVESEL)
768
                        {
769
                                OPL->wavesel = v&0x20;
770
                                if(!OPL->wavesel)
771
                                {
772
                                        /* preset compatible mode */
773
                                        int c;
774
                                        for(c=0;c<OPL->max_ch;c++)
775
                                        {
776
                                                OPL->P_CH[c].SLOT[SLOT1].wavetable = &SIN_TABLE[0];
777
                                                OPL->P_CH[c].SLOT[SLOT2].wavetable = &SIN_TABLE[0];
778
                                        }
779
                                }
780
                        }
781
                        return;
782
                case 0x02:        /* Timer 1 */
783
                        OPL->T[0] = (256-v)*4;
784
                        break;
785
                case 0x03:        /* Timer 2 */
786
                        OPL->T[1] = (256-v)*16;
787
                        return;
788
                case 0x04:        /* IRQ clear / mask and Timer enable */
789
                        if(v&0x80)
790
                        {        /* IRQ flag clear */
791
                                OPL_STATUS_RESET(OPL,0x7f);
792
                        }
793
                        else
794
                        {        /* set IRQ mask ,timer enable*/
795
                                UINT8 st1 = v&1;
796
                                UINT8 st2 = (v>>1)&1;
797
                                /* IRQRST,T1MSK,t2MSK,EOSMSK,BRMSK,x,ST2,ST1 */
798
                                OPL_STATUS_RESET(OPL,v&0x78);
799
                                OPL_STATUSMASK_SET(OPL,((~v)&0x78)|0x01);
800
                                /* timer 2 */
801
                                if(OPL->st[1] != st2)
802
                                {
803
                                        double interval = st2 ? (double)OPL->T[1]*OPL->TimerBase : 0.0;
804
                                        OPL->st[1] = st2;
805
                                        if (OPL->TimerHandler) (OPL->TimerHandler)(OPL->TimerParam+1,interval);
806
                                }
807
                                /* timer 1 */
808
                                if(OPL->st[0] != st1)
809
                                {
810
                                        double interval = st1 ? (double)OPL->T[0]*OPL->TimerBase : 0.0;
811
                                        OPL->st[0] = st1;
812
                                        if (OPL->TimerHandler) (OPL->TimerHandler)(OPL->TimerParam+0,interval);
813
                                }
814
                        }
815
                        return;
816
#if BUILD_Y8950
817
                case 0x06:                /* Key Board OUT */
818
                        if(OPL->type&OPL_TYPE_KEYBOARD)
819
                        {
820
                                if(OPL->keyboardhandler_w)
821
                                        OPL->keyboardhandler_w(OPL->keyboard_param,v);
822
                                else
823
                                        LOG(LOG_WAR,("OPL:write unmapped KEYBOARD port\n"));
824
                        }
825
                        return;
826
                case 0x07:        /* DELTA-T controll : START,REC,MEMDATA,REPT,SPOFF,x,x,RST */
827
                        if(OPL->type&OPL_TYPE_ADPCM)
828
                                YM_DELTAT_ADPCM_Write(OPL->deltat,r-0x07,v);
829
                        return;
830
                case 0x08:        /* MODE,DELTA-T : CSM,NOTESEL,x,x,smpl,da/ad,64k,rom */
831
                        OPL->mode = v;
832
                        v&=0x1f;        /* for DELTA-T unit */
833
                case 0x09:                /* START ADD */
834
                case 0x0a:
835
                case 0x0b:                /* STOP ADD  */
836
                case 0x0c:
837
                case 0x0d:                /* PRESCALE   */
838
                case 0x0e:
839
                case 0x0f:                /* ADPCM data */
840
                case 0x10:                 /* DELTA-N    */
841
                case 0x11:                 /* DELTA-N    */
842
                case 0x12:                 /* EG-CTRL    */
843
                        if(OPL->type&OPL_TYPE_ADPCM)
844
                                YM_DELTAT_ADPCM_Write(OPL->deltat,r-0x07,v);
845
                        return;
846
#if 0
847
                case 0x15:                /* DAC data    */
848
                case 0x16:
849
                case 0x17:                /* SHIFT    */
850
                        return;
851
                case 0x18:                /* I/O CTRL (Direction) */
852
                        if(OPL->type&OPL_TYPE_IO)
853
                                OPL->portDirection = v&0x0f;
854
                        return;
855
                case 0x19:                /* I/O DATA */
856
                        if(OPL->type&OPL_TYPE_IO)
857
                        {
858
                                OPL->portLatch = v;
859
                                if(OPL->porthandler_w)
860
                                        OPL->porthandler_w(OPL->port_param,v&OPL->portDirection);
861
                        }
862
                        return;
863
                case 0x1a:                /* PCM data */
864
                        return;
865
#endif
866
#endif
867
                }
868
                break;
869
        case 0x20:        /* am,vib,ksr,eg type,mul */
870
                slot = slot_array[r&0x1f];
871
                if(slot == -1) return;
872
                set_mul(OPL,slot,v);
873
                return;
874
        case 0x40:
875
                slot = slot_array[r&0x1f];
876
                if(slot == -1) return;
877
                set_ksl_tl(OPL,slot,v);
878
                return;
879
        case 0x60:
880
                slot = slot_array[r&0x1f];
881
                if(slot == -1) return;
882
                set_ar_dr(OPL,slot,v);
883
                return;
884
        case 0x80:
885
                slot = slot_array[r&0x1f];
886
                if(slot == -1) return;
887
                set_sl_rr(OPL,slot,v);
888
                return;
889
        case 0xa0:
890
                switch(r)
891
                {
892
                case 0xbd:
893
                        /* amsep,vibdep,r,bd,sd,tom,tc,hh */
894
                        {
895
                        UINT8 rkey = OPL->rythm^v;
896
                        OPL->ams_table = &AMS_TABLE[v&0x80 ? AMS_ENT : 0];
897
                        OPL->vib_table = &VIB_TABLE[v&0x40 ? VIB_ENT : 0];
898
                        OPL->rythm  = v&0x3f;
899
                        if(OPL->rythm&0x20)
900
                        {
901
#if 0
902
                                usrintf_showmessage("OPL Rythm mode select");
903
#endif
904
                                /* BD key on/off */
905
                                if(rkey&0x10)
906
                                {
907
                                        if(v&0x10)
908
                                        {
909
                                                OPL->P_CH[6].op1_out[0] = OPL->P_CH[6].op1_out[1] = 0;
910
                                                OPL_KEYON(&OPL->P_CH[6].SLOT[SLOT1]);
911
                                                OPL_KEYON(&OPL->P_CH[6].SLOT[SLOT2]);
912
                                        }
913
                                        else
914
                                        {
915
                                                OPL_KEYOFF(&OPL->P_CH[6].SLOT[SLOT1]);
916
                                                OPL_KEYOFF(&OPL->P_CH[6].SLOT[SLOT2]);
917
                                        }
918
                                }
919
                                /* SD key on/off */
920
                                if(rkey&0x08)
921
                                {
922
                                        if(v&0x08) OPL_KEYON(&OPL->P_CH[7].SLOT[SLOT2]);
923
                                        else       OPL_KEYOFF(&OPL->P_CH[7].SLOT[SLOT2]);
924
                                }/* TAM key on/off */
925
                                if(rkey&0x04)
926
                                {
927
                                        if(v&0x04) OPL_KEYON(&OPL->P_CH[8].SLOT[SLOT1]);
928
                                        else       OPL_KEYOFF(&OPL->P_CH[8].SLOT[SLOT1]);
929
                                }
930
                                /* TOP-CY key on/off */
931
                                if(rkey&0x02)
932
                                {
933
                                        if(v&0x02) OPL_KEYON(&OPL->P_CH[8].SLOT[SLOT2]);
934
                                        else       OPL_KEYOFF(&OPL->P_CH[8].SLOT[SLOT2]);
935
                                }
936
                                /* HH key on/off */
937
                                if(rkey&0x01)
938
                                {
939
                                        if(v&0x01) OPL_KEYON(&OPL->P_CH[7].SLOT[SLOT1]);
940
                                        else       OPL_KEYOFF(&OPL->P_CH[7].SLOT[SLOT1]);
941
                                }
942
                        }
943
                        }
944
                        return;
945
                }
946
                /* keyon,block,fnum */
947
                if( (r&0x0f) > 8) return;
948
                CH = &OPL->P_CH[r&0x0f];
949
                if(!(r&0x10))
950
                {        /* a0-a8 */
951
                        block_fnum  = (CH->block_fnum&0x1f00) | v;
952
                }
953
                else
954
                {        /* b0-b8 */
955
                        int keyon = (v>>5)&1;
956
                        block_fnum = ((v&0x1f)<<8) | (CH->block_fnum&0xff);
957
                        if(CH->keyon != keyon)
958
                        {
959
                                if( (CH->keyon=keyon) )
960
                                {
961
                                        CH->op1_out[0] = CH->op1_out[1] = 0;
962
                                        OPL_KEYON(&CH->SLOT[SLOT1]);
963
                                        OPL_KEYON(&CH->SLOT[SLOT2]);
964
                                }
965
                                else
966
                                {
967
                                        OPL_KEYOFF(&CH->SLOT[SLOT1]);
968
                                        OPL_KEYOFF(&CH->SLOT[SLOT2]);
969
                                }
970
                        }
971
                }
972
                /* update */
973
                if(CH->block_fnum != block_fnum)
974
                {
975
                        int blockRv = 7-(block_fnum>>10);
976
                        int fnum   = block_fnum&0x3ff;
977
                        CH->block_fnum = block_fnum;
978

    
979
                        CH->ksl_base = KSL_TABLE[block_fnum>>6];
980
                        CH->fc = OPL->FN_TABLE[fnum]>>blockRv;
981
                        CH->kcode = CH->block_fnum>>9;
982
                        if( (OPL->mode&0x40) && CH->block_fnum&0x100) CH->kcode |=1;
983
                        CALC_FCSLOT(CH,&CH->SLOT[SLOT1]);
984
                        CALC_FCSLOT(CH,&CH->SLOT[SLOT2]);
985
                }
986
                return;
987
        case 0xc0:
988
                /* FB,C */
989
                if( (r&0x0f) > 8) return;
990
                CH = &OPL->P_CH[r&0x0f];
991
                {
992
                int feedback = (v>>1)&7;
993
                CH->FB   = feedback ? (8+1) - feedback : 0;
994
                CH->CON = v&1;
995
                set_algorythm(CH);
996
                }
997
                return;
998
        case 0xe0: /* wave type */
999
                slot = slot_array[r&0x1f];
1000
                if(slot == -1) return;
1001
                CH = &OPL->P_CH[slot/2];
1002
                if(OPL->wavesel)
1003
                {
1004
                        /* LOG(LOG_INF,("OPL SLOT %d wave select %d\n",slot,v&3)); */
1005
                        CH->SLOT[slot&1].wavetable = &SIN_TABLE[(v&0x03)*SIN_ENT];
1006
                }
1007
                return;
1008
        }
1009
}
1010

    
1011
/* lock/unlock for common table */
1012
static int OPL_LockTable(void)
1013
{
1014
        num_lock++;
1015
        if(num_lock>1) return 0;
1016
        /* first time */
1017
        cur_chip = NULL;
1018
        /* allocate total level table (128kb space) */
1019
        if( !OPLOpenTable() )
1020
        {
1021
                num_lock--;
1022
                return -1;
1023
        }
1024
        return 0;
1025
}
1026

    
1027
static void OPL_UnLockTable(void)
1028
{
1029
        if(num_lock) num_lock--;
1030
        if(num_lock) return;
1031
        /* last time */
1032
        cur_chip = NULL;
1033
        OPLCloseTable();
1034
}
1035

    
1036
#if (BUILD_YM3812 || BUILD_YM3526)
1037
/*******************************************************************************/
1038
/*                YM3812 local section                                                   */
1039
/*******************************************************************************/
1040

    
1041
/* ---------- update one of chip ----------- */
1042
void YM3812UpdateOne(FM_OPL *OPL, INT16 *buffer, int length)
1043
{
1044
    int i;
1045
        int data;
1046
        OPLSAMPLE *buf = buffer;
1047
        UINT32 amsCnt  = OPL->amsCnt;
1048
        UINT32 vibCnt  = OPL->vibCnt;
1049
        UINT8 rythm = OPL->rythm&0x20;
1050
        OPL_CH *CH,*R_CH;
1051

    
1052
        if( (void *)OPL != cur_chip ){
1053
                cur_chip = (void *)OPL;
1054
                /* channel pointers */
1055
                S_CH = OPL->P_CH;
1056
                E_CH = &S_CH[9];
1057
                /* rythm slot */
1058
                SLOT7_1 = &S_CH[7].SLOT[SLOT1];
1059
                SLOT7_2 = &S_CH[7].SLOT[SLOT2];
1060
                SLOT8_1 = &S_CH[8].SLOT[SLOT1];
1061
                SLOT8_2 = &S_CH[8].SLOT[SLOT2];
1062
                /* LFO state */
1063
                amsIncr = OPL->amsIncr;
1064
                vibIncr = OPL->vibIncr;
1065
                ams_table = OPL->ams_table;
1066
                vib_table = OPL->vib_table;
1067
        }
1068
        R_CH = rythm ? &S_CH[6] : E_CH;
1069
    for( i=0; i < length ; i++ )
1070
        {
1071
                /*            channel A         channel B         channel C      */
1072
                /* LFO */
1073
                ams = ams_table[(amsCnt+=amsIncr)>>AMS_SHIFT];
1074
                vib = vib_table[(vibCnt+=vibIncr)>>VIB_SHIFT];
1075
                outd[0] = 0;
1076
                /* FM part */
1077
                for(CH=S_CH ; CH < R_CH ; CH++)
1078
                        OPL_CALC_CH(CH);
1079
                /* Rythn part */
1080
                if(rythm)
1081
                        OPL_CALC_RH(S_CH);
1082
                /* limit check */
1083
                data = Limit( outd[0] , OPL_MAXOUT, OPL_MINOUT );
1084
                /* store to sound buffer */
1085
                buf[i] = data >> OPL_OUTSB;
1086
        }
1087

    
1088
        OPL->amsCnt = amsCnt;
1089
        OPL->vibCnt = vibCnt;
1090
#ifdef OPL_OUTPUT_LOG
1091
        if(opl_dbg_fp)
1092
        {
1093
                for(opl_dbg_chip=0;opl_dbg_chip<opl_dbg_maxchip;opl_dbg_chip++)
1094
                        if( opl_dbg_opl[opl_dbg_chip] == OPL) break;
1095
                fprintf(opl_dbg_fp,"%c%c%c",0x20+opl_dbg_chip,length&0xff,length/256);
1096
        }
1097
#endif
1098
}
1099
#endif /* (BUILD_YM3812 || BUILD_YM3526) */
1100

    
1101
#if BUILD_Y8950
1102

    
1103
void Y8950UpdateOne(FM_OPL *OPL, INT16 *buffer, int length)
1104
{
1105
    int i;
1106
        int data;
1107
        OPLSAMPLE *buf = buffer;
1108
        UINT32 amsCnt  = OPL->amsCnt;
1109
        UINT32 vibCnt  = OPL->vibCnt;
1110
        UINT8 rythm = OPL->rythm&0x20;
1111
        OPL_CH *CH,*R_CH;
1112
        YM_DELTAT *DELTAT = OPL->deltat;
1113

    
1114
        /* setup DELTA-T unit */
1115
        YM_DELTAT_DECODE_PRESET(DELTAT);
1116

    
1117
        if( (void *)OPL != cur_chip ){
1118
                cur_chip = (void *)OPL;
1119
                /* channel pointers */
1120
                S_CH = OPL->P_CH;
1121
                E_CH = &S_CH[9];
1122
                /* rythm slot */
1123
                SLOT7_1 = &S_CH[7].SLOT[SLOT1];
1124
                SLOT7_2 = &S_CH[7].SLOT[SLOT2];
1125
                SLOT8_1 = &S_CH[8].SLOT[SLOT1];
1126
                SLOT8_2 = &S_CH[8].SLOT[SLOT2];
1127
                /* LFO state */
1128
                amsIncr = OPL->amsIncr;
1129
                vibIncr = OPL->vibIncr;
1130
                ams_table = OPL->ams_table;
1131
                vib_table = OPL->vib_table;
1132
        }
1133
        R_CH = rythm ? &S_CH[6] : E_CH;
1134
    for( i=0; i < length ; i++ )
1135
        {
1136
                /*            channel A         channel B         channel C      */
1137
                /* LFO */
1138
                ams = ams_table[(amsCnt+=amsIncr)>>AMS_SHIFT];
1139
                vib = vib_table[(vibCnt+=vibIncr)>>VIB_SHIFT];
1140
                outd[0] = 0;
1141
                /* deltaT ADPCM */
1142
                if( DELTAT->portstate )
1143
                        YM_DELTAT_ADPCM_CALC(DELTAT);
1144
                /* FM part */
1145
                for(CH=S_CH ; CH < R_CH ; CH++)
1146
                        OPL_CALC_CH(CH);
1147
                /* Rythn part */
1148
                if(rythm)
1149
                        OPL_CALC_RH(S_CH);
1150
                /* limit check */
1151
                data = Limit( outd[0] , OPL_MAXOUT, OPL_MINOUT );
1152
                /* store to sound buffer */
1153
                buf[i] = data >> OPL_OUTSB;
1154
        }
1155
        OPL->amsCnt = amsCnt;
1156
        OPL->vibCnt = vibCnt;
1157
        /* deltaT START flag */
1158
        if( !DELTAT->portstate )
1159
                OPL->status &= 0xfe;
1160
}
1161
#endif
1162

    
1163
/* ---------- reset one of chip ---------- */
1164
void OPLResetChip(FM_OPL *OPL)
1165
{
1166
        int c,s;
1167
        int i;
1168

    
1169
        /* reset chip */
1170
        OPL->mode   = 0;        /* normal mode */
1171
        OPL_STATUS_RESET(OPL,0x7f);
1172
        /* reset with register write */
1173
        OPLWriteReg(OPL,0x01,0); /* wabesel disable */
1174
        OPLWriteReg(OPL,0x02,0); /* Timer1 */
1175
        OPLWriteReg(OPL,0x03,0); /* Timer2 */
1176
        OPLWriteReg(OPL,0x04,0); /* IRQ mask clear */
1177
        for(i = 0xff ; i >= 0x20 ; i-- ) OPLWriteReg(OPL,i,0);
1178
        /* reset OPerator paramater */
1179
        for( c = 0 ; c < OPL->max_ch ; c++ )
1180
        {
1181
                OPL_CH *CH = &OPL->P_CH[c];
1182
                /* OPL->P_CH[c].PAN = OPN_CENTER; */
1183
                for(s = 0 ; s < 2 ; s++ )
1184
                {
1185
                        /* wave table */
1186
                        CH->SLOT[s].wavetable = &SIN_TABLE[0];
1187
                        /* CH->SLOT[s].evm = ENV_MOD_RR; */
1188
                        CH->SLOT[s].evc = EG_OFF;
1189
                        CH->SLOT[s].eve = EG_OFF+1;
1190
                        CH->SLOT[s].evs = 0;
1191
                }
1192
        }
1193
#if BUILD_Y8950
1194
        if(OPL->type&OPL_TYPE_ADPCM)
1195
        {
1196
                YM_DELTAT *DELTAT = OPL->deltat;
1197

    
1198
                DELTAT->freqbase = OPL->freqbase;
1199
                DELTAT->output_pointer = outd;
1200
                DELTAT->portshift = 5;
1201
                DELTAT->output_range = DELTAT_MIXING_LEVEL<<TL_BITS;
1202
                YM_DELTAT_ADPCM_Reset(DELTAT,0);
1203
        }
1204
#endif
1205
}
1206

    
1207
/* ----------  Create one of vietual YM3812 ----------       */
1208
/* 'rate'  is sampling rate and 'bufsiz' is the size of the  */
1209
FM_OPL *OPLCreate(int type, int clock, int rate)
1210
{
1211
        char *ptr;
1212
        FM_OPL *OPL;
1213
        int state_size;
1214
        int max_ch = 9; /* normaly 9 channels */
1215

    
1216
        if( OPL_LockTable() ==-1) return NULL;
1217
        /* allocate OPL state space */
1218
        state_size  = sizeof(FM_OPL);
1219
        state_size += sizeof(OPL_CH)*max_ch;
1220
#if BUILD_Y8950
1221
        if(type&OPL_TYPE_ADPCM) state_size+= sizeof(YM_DELTAT);
1222
#endif
1223
        /* allocate memory block */
1224
        ptr = malloc(state_size);
1225
        if(ptr==NULL) return NULL;
1226
        /* clear */
1227
        memset(ptr,0,state_size);
1228
        OPL        = (FM_OPL *)ptr; ptr+=sizeof(FM_OPL);
1229
        OPL->P_CH  = (OPL_CH *)ptr; ptr+=sizeof(OPL_CH)*max_ch;
1230
#if BUILD_Y8950
1231
        if(type&OPL_TYPE_ADPCM) OPL->deltat = (YM_DELTAT *)ptr; ptr+=sizeof(YM_DELTAT);
1232
#endif
1233
        /* set channel state pointer */
1234
        OPL->type  = type;
1235
        OPL->clock = clock;
1236
        OPL->rate  = rate;
1237
        OPL->max_ch = max_ch;
1238
        /* init grobal tables */
1239
        OPL_initalize(OPL);
1240
        /* reset chip */
1241
        OPLResetChip(OPL);
1242
#ifdef OPL_OUTPUT_LOG
1243
        if(!opl_dbg_fp)
1244
        {
1245
                opl_dbg_fp = fopen("opllog.opl","wb");
1246
                opl_dbg_maxchip = 0;
1247
        }
1248
        if(opl_dbg_fp)
1249
        {
1250
                opl_dbg_opl[opl_dbg_maxchip] = OPL;
1251
                fprintf(opl_dbg_fp,"%c%c%c%c%c%c",0x00+opl_dbg_maxchip,
1252
                        type,
1253
                        clock&0xff,
1254
                        (clock/0x100)&0xff,
1255
                        (clock/0x10000)&0xff,
1256
                        (clock/0x1000000)&0xff);
1257
                opl_dbg_maxchip++;
1258
        }
1259
#endif
1260
        return OPL;
1261
}
1262

    
1263
/* ----------  Destroy one of vietual YM3812 ----------       */
1264
void OPLDestroy(FM_OPL *OPL)
1265
{
1266
#ifdef OPL_OUTPUT_LOG
1267
        if(opl_dbg_fp)
1268
        {
1269
                fclose(opl_dbg_fp);
1270
                opl_dbg_fp = NULL;
1271
        }
1272
#endif
1273
        OPL_UnLockTable();
1274
        free(OPL);
1275
}
1276

    
1277
/* ----------  Option handlers ----------       */
1278

    
1279
void OPLSetTimerHandler(FM_OPL *OPL,OPL_TIMERHANDLER TimerHandler,int channelOffset)
1280
{
1281
        OPL->TimerHandler   = TimerHandler;
1282
        OPL->TimerParam = channelOffset;
1283
}
1284
void OPLSetIRQHandler(FM_OPL *OPL,OPL_IRQHANDLER IRQHandler,int param)
1285
{
1286
        OPL->IRQHandler     = IRQHandler;
1287
        OPL->IRQParam = param;
1288
}
1289
void OPLSetUpdateHandler(FM_OPL *OPL,OPL_UPDATEHANDLER UpdateHandler,int param)
1290
{
1291
        OPL->UpdateHandler = UpdateHandler;
1292
        OPL->UpdateParam = param;
1293
}
1294
#if BUILD_Y8950
1295
void OPLSetPortHandler(FM_OPL *OPL,OPL_PORTHANDLER_W PortHandler_w,OPL_PORTHANDLER_R PortHandler_r,int param)
1296
{
1297
        OPL->porthandler_w = PortHandler_w;
1298
        OPL->porthandler_r = PortHandler_r;
1299
        OPL->port_param = param;
1300
}
1301

    
1302
void OPLSetKeyboardHandler(FM_OPL *OPL,OPL_PORTHANDLER_W KeyboardHandler_w,OPL_PORTHANDLER_R KeyboardHandler_r,int param)
1303
{
1304
        OPL->keyboardhandler_w = KeyboardHandler_w;
1305
        OPL->keyboardhandler_r = KeyboardHandler_r;
1306
        OPL->keyboard_param = param;
1307
}
1308
#endif
1309
/* ---------- YM3812 I/O interface ---------- */
1310
int OPLWrite(FM_OPL *OPL,int a,int v)
1311
{
1312
        if( !(a&1) )
1313
        {        /* address port */
1314
                OPL->address = v & 0xff;
1315
        }
1316
        else
1317
        {        /* data port */
1318
                if(OPL->UpdateHandler) OPL->UpdateHandler(OPL->UpdateParam,0);
1319
#ifdef OPL_OUTPUT_LOG
1320
        if(opl_dbg_fp)
1321
        {
1322
                for(opl_dbg_chip=0;opl_dbg_chip<opl_dbg_maxchip;opl_dbg_chip++)
1323
                        if( opl_dbg_opl[opl_dbg_chip] == OPL) break;
1324
                fprintf(opl_dbg_fp,"%c%c%c",0x10+opl_dbg_chip,OPL->address,v);
1325
        }
1326
#endif
1327
                OPLWriteReg(OPL,OPL->address,v);
1328
        }
1329
        return OPL->status>>7;
1330
}
1331

    
1332
unsigned char OPLRead(FM_OPL *OPL,int a)
1333
{
1334
        if( !(a&1) )
1335
        {        /* status port */
1336
                return OPL->status & (OPL->statusmask|0x80);
1337
        }
1338
        /* data port */
1339
        switch(OPL->address)
1340
        {
1341
        case 0x05: /* KeyBoard IN */
1342
                if(OPL->type&OPL_TYPE_KEYBOARD)
1343
                {
1344
                        if(OPL->keyboardhandler_r)
1345
                                return OPL->keyboardhandler_r(OPL->keyboard_param);
1346
                        else
1347
                                LOG(LOG_WAR,("OPL:read unmapped KEYBOARD port\n"));
1348
                }
1349
                return 0;
1350
#if 0
1351
        case 0x0f: /* ADPCM-DATA  */
1352
                return 0;
1353
#endif
1354
        case 0x19: /* I/O DATA    */
1355
                if(OPL->type&OPL_TYPE_IO)
1356
                {
1357
                        if(OPL->porthandler_r)
1358
                                return OPL->porthandler_r(OPL->port_param);
1359
                        else
1360
                                LOG(LOG_WAR,("OPL:read unmapped I/O port\n"));
1361
                }
1362
                return 0;
1363
        case 0x1a: /* PCM-DATA    */
1364
                return 0;
1365
        }
1366
        return 0;
1367
}
1368

    
1369
int OPLTimerOver(FM_OPL *OPL,int c)
1370
{
1371
        if( c )
1372
        {        /* Timer B */
1373
                OPL_STATUS_SET(OPL,0x20);
1374
        }
1375
        else
1376
        {        /* Timer A */
1377
                OPL_STATUS_SET(OPL,0x40);
1378
                /* CSM mode key,TL controll */
1379
                if( OPL->mode & 0x80 )
1380
                {        /* CSM mode total level latch and auto key on */
1381
                        int ch;
1382
                        if(OPL->UpdateHandler) OPL->UpdateHandler(OPL->UpdateParam,0);
1383
                        for(ch=0;ch<9;ch++)
1384
                                CSMKeyControll( &OPL->P_CH[ch] );
1385
                }
1386
        }
1387
        /* reload timer */
1388
        if (OPL->TimerHandler) (OPL->TimerHandler)(OPL->TimerParam+c,(double)OPL->T[c]*OPL->TimerBase);
1389
        return OPL->status>>7;
1390
}