/* arch/arm/mach-msm/htc_acoustic_qsd.c * * Copyright (C) 2009 HTC Corporation * * This software is licensed under the terms of the GNU General Public * License version 2, as published by the Free Software Foundation, and * may be copied, distributed, and modified under those terms. * * This program 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 General Public License for more details. * */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "smd_private.h" #define ACOUSTIC_IOCTL_MAGIC 'p' #define ACOUSTIC_UPDATE_ADIE \ _IOW(ACOUSTIC_IOCTL_MAGIC, 24, unsigned int) #define HTCACOUSTICPROG 0x30100003 #define HTCACOUSTICVERS 0 #define ONCRPC_ALLOC_ACOUSTIC_MEM_PROC (1) #define ONCRPC_UPDATE_ADIE_PROC (2) #define ONCRPC_ENABLE_AUX_PGA_LOOPBACK_PROC (3) #define ONCRPC_FORCE_HEADSET_SPEAKER_PROC (4) #define HTC_ACOUSTIC_TABLE_SIZE (0x20000) #define D(fmt, args...) printk(KERN_INFO "htc-acoustic: "fmt, ##args) #define E(fmt, args...) printk(KERN_ERR "htc-acoustic: "fmt, ##args) static uint32_t htc_acoustic_vir_addr; static struct msm_rpc_endpoint *endpoint; static struct mutex api_lock; static struct mutex rpc_connect_lock; static struct qsd_acoustic_ops *the_ops; void acoustic_register_ops(struct qsd_acoustic_ops *ops) { the_ops = ops; } static int is_rpc_connect(void) { mutex_lock(&rpc_connect_lock); if (endpoint == NULL) { endpoint = msm_rpc_connect(HTCACOUSTICPROG, HTCACOUSTICVERS, 0); if (IS_ERR(endpoint)) { pr_err("%s: init rpc failed! rc = %ld\n", __func__, PTR_ERR(endpoint)); mutex_unlock(&rpc_connect_lock); return -1; } } mutex_unlock(&rpc_connect_lock); return 0; } int turn_mic_bias_on(int on) { D("%s called %d\n", __func__, on); if (the_ops->enable_mic_bias) the_ops->enable_mic_bias(on); return 0; } EXPORT_SYMBOL(turn_mic_bias_on); int force_headset_speaker_on(int enable) { struct speaker_headset_req { struct rpc_request_hdr hdr; uint32_t enable; } spkr_req; D("%s called %d\n", __func__, enable); if (is_rpc_connect() == -1) return -1; spkr_req.enable = cpu_to_be32(enable); return msm_rpc_call(endpoint, ONCRPC_FORCE_HEADSET_SPEAKER_PROC, &spkr_req, sizeof(spkr_req), 5 * HZ); } EXPORT_SYMBOL(force_headset_speaker_on); int enable_aux_loopback(uint32_t enable) { struct aux_loopback_req { struct rpc_request_hdr hdr; uint32_t enable; } aux_req; D("%s called %d\n", __func__, enable); if (is_rpc_connect() == -1) return -1; aux_req.enable = cpu_to_be32(enable); return msm_rpc_call(endpoint, ONCRPC_ENABLE_AUX_PGA_LOOPBACK_PROC, &aux_req, sizeof(aux_req), 5 * HZ); } EXPORT_SYMBOL(enable_aux_loopback); static int acoustic_mmap(struct file *file, struct vm_area_struct *vma) { unsigned long pgoff; int rc = -EINVAL; size_t size; D("mmap\n"); mutex_lock(&api_lock); size = vma->vm_end - vma->vm_start; if (vma->vm_pgoff != 0) { E("mmap failed: page offset %lx\n", vma->vm_pgoff); goto done; } if (!htc_acoustic_vir_addr) { E("mmap failed: smem region not allocated\n"); rc = -EIO; goto done; } pgoff = MSM_SHARED_RAM_PHYS + (htc_acoustic_vir_addr - (uint32_t)MSM_SHARED_RAM_BASE); pgoff = ((pgoff + 4095) & ~4095); htc_acoustic_vir_addr = ((htc_acoustic_vir_addr + 4095) & ~4095); if (pgoff <= 0) { E("pgoff wrong. %ld\n", pgoff); goto done; } if (size <= HTC_ACOUSTIC_TABLE_SIZE) { pgoff = pgoff >> PAGE_SHIFT; } else { E("size > HTC_ACOUSTIC_TABLE_SIZE %d\n", size); goto done; } vma->vm_flags |= VM_IO | VM_RESERVED; rc = io_remap_pfn_range(vma, vma->vm_start, pgoff, size, vma->vm_page_prot); if (rc < 0) E("mmap failed: remap error %d\n", rc); done: mutex_unlock(&api_lock); return rc; } static int acoustic_open(struct inode *inode, struct file *file) { int reply_value; int rc = -EIO; struct set_smem_req { struct rpc_request_hdr hdr; uint32_t size; } req_smem; struct set_smem_rep { struct rpc_reply_hdr hdr; int n; } rep_smem; D("open\n"); mutex_lock(&api_lock); if (!htc_acoustic_vir_addr) { if (is_rpc_connect() == -1) goto done; req_smem.size = cpu_to_be32(HTC_ACOUSTIC_TABLE_SIZE); rc = msm_rpc_call_reply(endpoint, ONCRPC_ALLOC_ACOUSTIC_MEM_PROC, &req_smem, sizeof(req_smem), &rep_smem, sizeof(rep_smem), 5 * HZ); reply_value = be32_to_cpu(rep_smem.n); if (reply_value != 0 || rc < 0) { E("open failed: ALLOC_ACOUSTIC_MEM_PROC error %d.\n", rc); goto done; } htc_acoustic_vir_addr = (uint32_t)smem_alloc(SMEM_ID_VENDOR1, HTC_ACOUSTIC_TABLE_SIZE); if (!htc_acoustic_vir_addr) { E("open failed: smem_alloc error\n"); goto done; } } rc = 0; done: mutex_unlock(&api_lock); return rc; } static int acoustic_release(struct inode *inode, struct file *file) { D("release\n"); return 0; } static long acoustic_ioctl(struct file *file, unsigned int cmd, unsigned long arg) { int rc, reply_value; D("ioctl\n"); mutex_lock(&api_lock); switch (cmd) { case ACOUSTIC_UPDATE_ADIE: { struct update_adie_req { struct rpc_request_hdr hdr; int id; } adie_req; struct update_adie_rep { struct rpc_reply_hdr hdr; int ret; } adie_rep; D("ioctl: ACOUSTIC_UPDATE_ADIE called %d.\n", current->pid); adie_req.id = cpu_to_be32(-1); /* update all codecs */ rc = msm_rpc_call_reply(endpoint, ONCRPC_UPDATE_ADIE_PROC, &adie_req, sizeof(adie_req), &adie_rep, sizeof(adie_rep), 5 * HZ); reply_value = be32_to_cpu(adie_rep.ret); if (reply_value != 0 || rc < 0) { E("ioctl failed: ONCRPC_UPDATE_ADIE_PROC "\ "error %d.\n", rc); if (rc >= 0) rc = -EIO; break; } D("ioctl: ONCRPC_UPDATE_ADIE_PROC success.\n"); break; } default: E("ioctl: invalid command\n"); rc = -EINVAL; } mutex_unlock(&api_lock); return rc; } struct rpc_set_uplink_mute_args { int mute; }; static struct file_operations acoustic_fops = { .owner = THIS_MODULE, .open = acoustic_open, .release = acoustic_release, .mmap = acoustic_mmap, .unlocked_ioctl = acoustic_ioctl, }; static struct miscdevice acoustic_misc = { .minor = MISC_DYNAMIC_MINOR, .name = "htc-acoustic", .fops = &acoustic_fops, }; static int __init acoustic_init(void) { mutex_init(&api_lock); mutex_init(&rpc_connect_lock); return misc_register(&acoustic_misc); } static void __exit acoustic_exit(void) { misc_deregister(&acoustic_misc); } module_init(acoustic_init); module_exit(acoustic_exit);