2 * a.lp_mp3 - VS1011B driver for Fonera
3 * Copyright (c) 2007 phrozen.org - John Crispin <john@phrozen.org>
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the Free Software
17 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA02111-1307USA
19 * Feedback, Bugs... john@phrozen.org
24 #include <linux/module.h>
25 #include <linux/errno.h>
26 #include <linux/ioport.h>
27 #include <linux/init.h>
28 #include <asm/uaccess.h>
30 #include <linux/timer.h>
31 #include <linux/init.h>
32 #include <linux/genhd.h>
33 #include <linux/device.h>
35 // do we want debuging info ?
42 #define MP3_CHUNK_SIZE 4096
43 #define MP3_BUFFERING 0
45 #define MP3_BUFFER_FINISHED 2
46 #define MP3_PLAY_FINISHED 3
47 typedef struct _MP3_DATA{
48 unsigned char mp3[MP3_CHUNK_SIZE];
52 #define IOCTL_MP3_INIT 0x01
53 #define IOCTL_MP3_RESET 0x02
54 #define IOCTL_MP3_SETVOLUME 0x03
55 #define IOCTL_MP3_GETVOLUME 0x04
57 typedef struct _AUDIO_DATA{
59 unsigned int sample_rate;
60 unsigned char is_stereo;
62 #define IOCTL_MP3_GETAUDIODATA 0x05
63 #define IOCTL_MP3_CLEARBUFFER 0x06
64 #define IOCTL_MP3_PLAY 0x07
66 typedef struct _MP3_BEEP{
70 #define IOCTL_MP3_BEEP 0x08
71 #define IOCTL_MP3_END_REACHED 0x09
72 #define IOCTL_MP3_BASS 0x10
74 #define CRYSTAL12288 0x9800
75 #define CRYSTAL24576 0x0
77 #define DEV_NAME "mp3"
79 #define MAX_MP3_COUNT 1
81 typedef struct _mp3_inf{
82 unsigned char is_open;
84 static mp3_inf mp3_info[MAX_MP3_COUNT];
86 #define MP3_BUFFER_SIZE (128 * 1024)
87 unsigned char mp3_buffer[MP3_BUFFER_SIZE];
89 static unsigned long int mp3_buffer_offset_write = 0;
90 static unsigned long int mp3_buffer_offset_read = 0;
91 static unsigned char mp3_buffering_status = MP3_BUFFERING;
92 static unsigned long int mp3_data_in_buffer = 0;
93 static int mp3_thread = 0;
94 unsigned int crystal_freq;
98 static wait_queue_head_t wq;
99 static DECLARE_COMPLETION(mp3_exit);
101 static int mp3_playback_thread(void *data){
103 unsigned long timeout;
104 printk("started kthread\n");
106 while(mp3_buffering_status != MP3_PLAY_FINISHED){
107 if((mp3_buffering_status == MP3_PLAYING) || (mp3_buffering_status == MP3_BUFFER_FINISHED)){
108 while(VS1011_NEEDS_DATA){
109 if(mp3_buffer_offset_read == MP3_BUFFER_SIZE){
110 mp3_buffer_offset_read = 0;
113 if(mp3_data_in_buffer == 0){
114 if(mp3_buffering_status == MP3_BUFFER_FINISHED){
115 printk("mp3_drv.ko : finished playing\n");
116 mp3_buffering_status = MP3_PLAY_FINISHED;
118 printk("mp3_drv.ko : buffer empty ?\n");
119 if(mp3_buffering_status != MP3_PLAY_FINISHED){
123 for(j = 0; j < 32; j++){
124 VS1011_send_SDI(mp3_buffer[mp3_buffer_offset_read + j]);
126 mp3_buffer_offset_read += 32;
127 mp3_data_in_buffer -= 32;
132 timeout = wait_event_interruptible_timeout(wq, (timeout==0), timeout);
134 complete_and_exit(&mp3_exit, 0);
137 static ssize_t module_write(struct file * file, const char * buffer, size_t count, loff_t *offset){
140 copy_from_user((char*) &mp3_data, buffer, sizeof(MP3_DATA));
142 if(mp3_data.state == MP3_BUFFER_FINISHED){
143 mp3_buffering_status = MP3_BUFFER_FINISHED;
144 DBG(printk("mp3_drv.ko : file end reached\n"));
148 if(mp3_data.state == MP3_PLAY_FINISHED){
149 mp3_buffering_status = MP3_PLAY_FINISHED;
150 mp3_data_in_buffer = 0;
151 DBG(printk("mp3_drv.ko : stop playing\n"));
155 if(mp3_data_in_buffer + MP3_CHUNK_SIZE >= MP3_BUFFER_SIZE){
156 DBG(printk("mp3_drv.ko : buffer is full? %ld\n", mp3_data_in_buffer);)
160 if(mp3_buffer_offset_write == MP3_BUFFER_SIZE){
161 mp3_buffer_offset_write = 0;
164 memcpy(&mp3_buffer[mp3_buffer_offset_write], mp3_data.mp3, MP3_CHUNK_SIZE);
165 mp3_buffer_offset_write += MP3_CHUNK_SIZE;
166 mp3_buffering_status = mp3_data.state;
167 mp3_data_in_buffer += MP3_CHUNK_SIZE;
171 static int module_ioctl(struct inode * inode, struct file * file, unsigned int cmd, unsigned long arg){
172 unsigned int retval = 0;
173 AUDIO_DATA audio_data;
175 DBG(printk("mp3_drv.ko : Ioctl Called (cmd=%d)\n", cmd );)
179 VS1011_init(crystal_freq, 1);
180 VS1011_print_registers();
183 case IOCTL_MP3_RESET:
184 DBG(printk("mp3_drv.ko : doing a sw reset\n");)
185 VS1011_init(crystal_freq, 0);
186 VS1011_print_registers();
187 VS1011_send_zeros(0x20);
190 case IOCTL_MP3_SETVOLUME:
191 DBG(printk("mp3_drv.ko : setting volume to : %lu\n", arg&0xffff);)
192 VS1011_set_volume(arg);
195 case IOCTL_MP3_GETVOLUME:
196 retval = VS1011_get_volume();
197 DBG(printk("mp3_drv.ko : read volume : %d\n", retval);)
200 case IOCTL_MP3_GETAUDIODATA:
201 DBG(printk("mp3_drv.ko : read audio data\n");)
202 VS1011_get_audio_data(&audio_data);
203 copy_to_user((char*)arg, (char*)&audio_data, sizeof(AUDIO_DATA));
206 case IOCTL_MP3_CLEARBUFFER:
207 DBG(printk("mp3_drv.ko : clearing buffer\n");)
208 mp3_buffer_offset_read = 0;
209 mp3_buffer_offset_write = 0;
210 mp3_buffering_status = MP3_PLAY_FINISHED;
211 mp3_data_in_buffer = 0;
215 mp3_thread = kernel_thread(mp3_playback_thread, NULL, CLONE_KERNEL);
219 copy_from_user((char*)&mp3_beep, (char*)arg, sizeof(MP3_BEEP));
220 VS1011_sine(1,mp3_beep.freq);
221 msDelay(mp3_beep.ms);
225 case IOCTL_MP3_END_REACHED:
226 if(mp3_buffering_status == MP3_PLAY_FINISHED){
232 VS1011_set_bass(arg);
236 printk("mp3_drv.ko : unknown ioctl\n");
243 static int module_open(struct inode *inode, struct file *file){
244 unsigned int dev_minor = MINOR(inode->i_rdev);
246 printk("mp3_drv.ko : trying to access unknown minor device -> %d\n", dev_minor);
249 if(mp3_info[dev_minor].is_open) {
250 printk("mp3_drv.ko : Device with minor ID %d already in use\n", dev_minor);
253 mp3_info[dev_minor].is_open = 1;
255 mp3_buffering_status = MP3_PLAY_FINISHED;
256 printk("mp3_drv.ko : Minor %d has been opened\n", dev_minor);
260 static int module_close(struct inode * inode, struct file * file){
261 unsigned int dev_minor = MINOR(inode->i_rdev);
262 mp3_info[dev_minor].is_open = 0;
263 printk("mp3_drv.ko : Minor %d has been closed\n", dev_minor);
264 mp3_buffering_status = MP3_PLAY_FINISHED;
268 struct file_operations modulemp3_fops = {
272 release: module_close
275 static struct class *mp3_class;
277 static int __init mod_init(void){
278 printk("mp3_drv.ko : VS1011b Driver\n");
279 printk("mp3_drv.ko : Made by John '2B|!2B' Crispin (john@phrozen.org)\n");
280 printk("mp3_drv.ko : Starting ...\n");
282 if(register_chrdev(DEV_MAJOR, DEV_NAME, &modulemp3_fops)) {
283 printk( "mp3_drv.ko : Error whilst opening %s (%d)\n", DEV_NAME, DEV_MAJOR);
287 printk("mp3_drv.ko : using sysfs to create device nodes\n");
288 mp3_class = class_create(THIS_MODULE, DEV_NAME);
289 class_device_create(mp3_class, NULL,
293 mp3_info[0].is_open = 0;
294 printk("mp3_drv.ko : Device %s registered for major ID %d\n", DEV_NAME, DEV_MAJOR);
295 crystal_freq = CRYSTAL12288;
296 VS1011_init(crystal_freq, 1);
297 VS1011_print_registers();
298 printk("end of init\n");
299 init_waitqueue_head(&wq);
300 printk("wait queue started\n");
304 static void __exit mod_exit(void){
305 printk( "mp3_drv.ko : Cleanup\n" );
306 unregister_chrdev(DEV_MAJOR, DEV_NAME);
309 module_init (mod_init);
310 module_exit (mod_exit);
312 MODULE_LICENSE("GPL");
313 MODULE_AUTHOR("K. John '2B|!2B' Crispin");
314 MODULE_DESCRIPTION("vs1011 Driver for Fox Board");