1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
|
/*
* This file is part of WorkMan, the civilized CD player library
* Copyright (C) 1991-1997 by Steven Grimm (original author)
* Copyright (C) by Dirk Försterling <milliByte@DeathsDoor.com>
* Copyright (C) 2004-2006 Alexander Kern <alex.kern@gmx.de>
*
* This library is free software; you can redistribute it and/or
* modify it under the terms of the GNU Library General Public
* License as published by the Free Software Foundation; either
* version 2 of the License, or (at your option) any later version.
*
* This library is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
* Library General Public License for more details.
*
* You should have received a copy of the GNU Library General Public
* License along with this library; if not, write to the Free
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
*
*
* Vendor-specific drive control routines for Toshiba XM-3401 series.
*/
#include <stdio.h>
#include <errno.h>
#include "include/wm_config.h"
#include "include/wm_struct.h"
#include "include/wm_scsi.h"
#define SCMD_TOSH_EJECT 0xc4
/* local prototypes */
/* static int min_volume = 0, max_volume = 255; */
/*
* Undo the transformation above using a binary search (so no floating-point
* math is required.)
*/
static int unscale_volume(int cd_vol, int max)
{
int vol = 0, top = max, bot = 0, scaled = 0;
/*cd_vol = (cd_vol * 100 + (max_volume - 1)) / max_volume;*/
while (bot <= top)
{
vol = (top + bot) / 2;
scaled = (vol * vol) / max;
if (cd_vol <= scaled)
top = vol - 1;
else
bot = vol + 1;
}
/* Might have looked down too far for repeated scaled values */
if (cd_vol < scaled)
vol++;
if (vol < 0)
vol = 0;
else if (vol > max)
vol = max;
return (vol);
}
/*
* Send the Toshiba code to eject the CD.
*/
static int tosh_eject(struct wm_drive *d)
{
return sendscsi(d, NULL, 0, 0, SCMD_TOSH_EJECT, 1, 0,0,0,0,0,0,0,0,0,0);
}
/*
* Set the volume. The low end of the scale is more sensitive than the high
* end, so make up for that by transforming the volume parameters to a square
* curve.
*/
static int tosh_scale_volume(int *left, int *right)
{
*left = (*left * *left * *left) / 10000;
*right = (*right * *right * *right) / 10000;
return 0;
}
static int tosh_unscale_volume(int *left, int *right)
{
*left = unscale_volume(*left, 100);
*right = unscale_volume(*right, 100);
return 0;
}
int toshiba_fixup(struct wm_drive *d)
{
d->proto.eject = tosh_eject;
d->proto.scale_volume = tosh_scale_volume;
d->proto.unscale_volume = tosh_unscale_volume;
return 0;
}
|