usb: gadget: SPS BAM-to-BAM - USB BAM driver
USB BAM driver to support BAM-to-BAM USB<->Peripheral transactions. Change-Id: Ib49a41f5dcdccb6f6bff2492fa64ead40f18b870 Signed-off-by: Ofir Cohen <ofirc@codeaurora.org>
This commit is contained in:
Ofir Cohen
Stephen Boyd
25
arch/arm/mach-msm/include/mach/msm_sps.h
Normal file
25
arch/arm/mach-msm/include/mach/msm_sps.h
Normal file
@@ -0,0 +1,25 @@
|
||||
/* Copyright (c) 2011, Code Aurora Forum. All rights reserved.
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License version 2 and
|
||||
* only version 2 as published by the Free Software Foundation.
|
||||
*
|
||||
* 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.
|
||||
*/
|
||||
#ifndef _MSM_SPS_H_
|
||||
#define _MSM_SPS_H_
|
||||
|
||||
/**
|
||||
* struct msm_sps_platform_data - SPS Platform specific data.
|
||||
* @bamdma_restricted_pipes - Bitmask of pipes restricted from local use.
|
||||
*
|
||||
*/
|
||||
struct msm_sps_platform_data {
|
||||
u32 bamdma_restricted_pipes;
|
||||
};
|
||||
|
||||
#endif /* _MSM_SPS_H_ */
|
||||
|
||||
@@ -23,6 +23,14 @@ config SPS
|
||||
2. Peripheral-to-Memory.
|
||||
3. Memory-to-Memory.
|
||||
|
||||
config USB_BAM
|
||||
boolean "USB BAM Driver"
|
||||
depends on SPS && USB_GADGET
|
||||
help
|
||||
Enabling this option adds USB BAM Driver.
|
||||
USB BAM driver was added to supports SPS Peripheral-to-Peripheral
|
||||
transfers between the USB and other peripheral.
|
||||
|
||||
config SPS_SUPPORT_BAMDMA
|
||||
bool "SPS support BAM DMA"
|
||||
depends on SPS
|
||||
|
||||
@@ -2,4 +2,5 @@
|
||||
# Makefile for the MSM specific device drivers.
|
||||
#
|
||||
obj-$(CONFIG_MSM_SSBI) += ssbi.o
|
||||
obj-$(CONFIG_USB_BAM) += usb_bam.o
|
||||
obj-$(CONFIG_SPS) += sps/
|
||||
|
||||
394
drivers/platform/msm/usb_bam.c
Normal file
394
drivers/platform/msm/usb_bam.c
Normal file
@@ -0,0 +1,394 @@
|
||||
/* Copyright (c) 2011-2012, Code Aurora Forum. All rights reserved.
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License version 2 and
|
||||
* only version 2 as published by the Free Software Foundation.
|
||||
*
|
||||
* 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 <linux/types.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/list.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/stat.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/usb/msm_hsusb.h>
|
||||
#include <mach/usb_bam.h>
|
||||
#include <mach/sps.h>
|
||||
#include <linux/workqueue.h>
|
||||
|
||||
#define USB_SUMMING_THRESHOLD 512
|
||||
#define CONNECTIONS_NUM 4
|
||||
|
||||
static struct sps_bam_props usb_props;
|
||||
static struct sps_pipe *sps_pipes[CONNECTIONS_NUM][2];
|
||||
static struct sps_connect sps_connections[CONNECTIONS_NUM][2];
|
||||
static struct sps_mem_buffer data_mem_buf[CONNECTIONS_NUM][2];
|
||||
static struct sps_mem_buffer desc_mem_buf[CONNECTIONS_NUM][2];
|
||||
static struct platform_device *usb_bam_pdev;
|
||||
static struct workqueue_struct *usb_bam_wq;
|
||||
|
||||
struct usb_bam_wake_event_info {
|
||||
struct sps_register_event event;
|
||||
int (*callback)(void *);
|
||||
void *param;
|
||||
struct work_struct wake_w;
|
||||
};
|
||||
|
||||
struct usb_bam_connect_info {
|
||||
u8 idx;
|
||||
u8 *src_pipe;
|
||||
u8 *dst_pipe;
|
||||
struct usb_bam_wake_event_info peer_event;
|
||||
bool enabled;
|
||||
};
|
||||
|
||||
static struct usb_bam_connect_info usb_bam_connections[CONNECTIONS_NUM];
|
||||
|
||||
static inline int bam_offset(struct msm_usb_bam_platform_data *pdata)
|
||||
{
|
||||
return pdata->usb_active_bam * CONNECTIONS_NUM * 2;
|
||||
}
|
||||
|
||||
static int connect_pipe(u8 connection_idx, enum usb_bam_pipe_dir pipe_dir,
|
||||
u8 *usb_pipe_idx)
|
||||
{
|
||||
int ret;
|
||||
struct sps_pipe **pipe = &sps_pipes[connection_idx][pipe_dir];
|
||||
struct sps_connect *connection =
|
||||
&sps_connections[connection_idx][pipe_dir];
|
||||
struct msm_usb_bam_platform_data *pdata =
|
||||
(struct msm_usb_bam_platform_data *)
|
||||
(usb_bam_pdev->dev.platform_data);
|
||||
struct usb_bam_pipe_connect *pipe_connection =
|
||||
(struct usb_bam_pipe_connect *)(pdata->connections +
|
||||
bam_offset(pdata) + (2*connection_idx+pipe_dir));
|
||||
|
||||
*pipe = sps_alloc_endpoint();
|
||||
if (*pipe == NULL) {
|
||||
pr_err("%s: sps_alloc_endpoint failed\n", __func__);
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
ret = sps_get_config(*pipe, connection);
|
||||
if (ret) {
|
||||
pr_err("%s: tx get config failed %d\n", __func__, ret);
|
||||
goto get_config_failed;
|
||||
}
|
||||
|
||||
ret = sps_phy2h(pipe_connection->src_phy_addr, &(connection->source));
|
||||
if (ret) {
|
||||
pr_err("%s: sps_phy2h failed (src BAM) %d\n", __func__, ret);
|
||||
goto get_config_failed;
|
||||
}
|
||||
|
||||
connection->src_pipe_index = pipe_connection->src_pipe_index;
|
||||
ret = sps_phy2h(pipe_connection->dst_phy_addr,
|
||||
&(connection->destination));
|
||||
if (ret) {
|
||||
pr_err("%s: sps_phy2h failed (dst BAM) %d\n", __func__, ret);
|
||||
goto get_config_failed;
|
||||
}
|
||||
connection->dest_pipe_index = pipe_connection->dst_pipe_index;
|
||||
|
||||
if (pipe_dir == USB_TO_PEER_PERIPHERAL) {
|
||||
connection->mode = SPS_MODE_SRC;
|
||||
*usb_pipe_idx = connection->src_pipe_index;
|
||||
} else {
|
||||
connection->mode = SPS_MODE_DEST;
|
||||
*usb_pipe_idx = connection->dest_pipe_index;
|
||||
}
|
||||
|
||||
ret = sps_setup_bam2bam_fifo(
|
||||
&data_mem_buf[connection_idx][pipe_dir],
|
||||
pipe_connection->data_fifo_base_offset,
|
||||
pipe_connection->data_fifo_size, 1);
|
||||
if (ret) {
|
||||
pr_err("%s: data fifo setup failure %d\n", __func__, ret);
|
||||
goto fifo_setup_error;
|
||||
}
|
||||
connection->data = data_mem_buf[connection_idx][pipe_dir];
|
||||
|
||||
ret = sps_setup_bam2bam_fifo(
|
||||
&desc_mem_buf[connection_idx][pipe_dir],
|
||||
pipe_connection->desc_fifo_base_offset,
|
||||
pipe_connection->desc_fifo_size, 1);
|
||||
if (ret) {
|
||||
pr_err("%s: desc. fifo setup failure %d\n", __func__, ret);
|
||||
goto fifo_setup_error;
|
||||
}
|
||||
connection->desc = desc_mem_buf[connection_idx][pipe_dir];
|
||||
connection->event_thresh = 512;
|
||||
|
||||
ret = sps_connect(*pipe, connection);
|
||||
if (ret < 0) {
|
||||
pr_err("%s: tx connect error %d\n", __func__, ret);
|
||||
goto error;
|
||||
}
|
||||
return 0;
|
||||
|
||||
error:
|
||||
sps_disconnect(*pipe);
|
||||
fifo_setup_error:
|
||||
get_config_failed:
|
||||
sps_free_endpoint(*pipe);
|
||||
return ret;
|
||||
}
|
||||
|
||||
int usb_bam_connect(u8 idx, u8 *src_pipe_idx, u8 *dst_pipe_idx)
|
||||
{
|
||||
struct usb_bam_connect_info *connection = &usb_bam_connections[idx];
|
||||
int ret;
|
||||
|
||||
if (idx >= CONNECTIONS_NUM) {
|
||||
pr_err("%s: Invalid connection index\n",
|
||||
__func__);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
if (connection->enabled) {
|
||||
pr_info("%s: connection %d was already established\n",
|
||||
__func__, idx);
|
||||
return 0;
|
||||
}
|
||||
connection->src_pipe = src_pipe_idx;
|
||||
connection->dst_pipe = dst_pipe_idx;
|
||||
connection->idx = idx;
|
||||
|
||||
/* open USB -> Peripheral pipe */
|
||||
ret = connect_pipe(connection->idx, USB_TO_PEER_PERIPHERAL,
|
||||
connection->src_pipe);
|
||||
if (ret) {
|
||||
pr_err("%s: src pipe connection failure\n", __func__);
|
||||
return ret;
|
||||
}
|
||||
/* open Peripheral -> USB pipe */
|
||||
ret = connect_pipe(connection->idx, PEER_PERIPHERAL_TO_USB,
|
||||
connection->dst_pipe);
|
||||
if (ret) {
|
||||
pr_err("%s: dst pipe connection failure\n", __func__);
|
||||
return ret;
|
||||
}
|
||||
connection->enabled = 1;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void usb_bam_wake_work(struct work_struct *w)
|
||||
{
|
||||
struct usb_bam_wake_event_info *wake_event_info =
|
||||
container_of(w, struct usb_bam_wake_event_info, wake_w);
|
||||
|
||||
wake_event_info->callback(wake_event_info->param);
|
||||
}
|
||||
|
||||
static void usb_bam_wake_cb(struct sps_event_notify *notify)
|
||||
{
|
||||
struct usb_bam_wake_event_info *wake_event_info =
|
||||
(struct usb_bam_wake_event_info *)notify->user;
|
||||
|
||||
queue_work(usb_bam_wq, &wake_event_info->wake_w);
|
||||
}
|
||||
|
||||
int usb_bam_register_wake_cb(u8 idx,
|
||||
int (*callback)(void *user), void* param)
|
||||
{
|
||||
struct sps_pipe *pipe = sps_pipes[idx][PEER_PERIPHERAL_TO_USB];
|
||||
struct sps_connect *sps_connection =
|
||||
&sps_connections[idx][PEER_PERIPHERAL_TO_USB];
|
||||
struct usb_bam_connect_info *connection = &usb_bam_connections[idx];
|
||||
struct usb_bam_wake_event_info *wake_event_info =
|
||||
&connection->peer_event;
|
||||
int ret;
|
||||
|
||||
wake_event_info->param = param;
|
||||
wake_event_info->callback = callback;
|
||||
wake_event_info->event.mode = SPS_TRIGGER_CALLBACK;
|
||||
wake_event_info->event.xfer_done = NULL;
|
||||
wake_event_info->event.callback = callback ? usb_bam_wake_cb : NULL;
|
||||
wake_event_info->event.user = wake_event_info;
|
||||
wake_event_info->event.options = SPS_O_WAKEUP;
|
||||
ret = sps_register_event(pipe, &wake_event_info->event);
|
||||
if (ret) {
|
||||
pr_err("%s: sps_register_event() failed %d\n", __func__, ret);
|
||||
return ret;
|
||||
}
|
||||
|
||||
sps_connection->options = callback ?
|
||||
(SPS_O_AUTO_ENABLE | SPS_O_WAKEUP | SPS_O_WAKEUP_IS_ONESHOT) :
|
||||
SPS_O_AUTO_ENABLE;
|
||||
ret = sps_set_config(pipe, sps_connection);
|
||||
if (ret) {
|
||||
pr_err("%s: sps_set_config() failed %d\n", __func__, ret);
|
||||
return ret;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int usb_bam_init(void)
|
||||
{
|
||||
u32 h_usb;
|
||||
int ret;
|
||||
void *usb_virt_addr;
|
||||
struct msm_usb_bam_platform_data *pdata =
|
||||
(struct msm_usb_bam_platform_data *)
|
||||
(usb_bam_pdev->dev.platform_data);
|
||||
struct resource *res;
|
||||
int irq;
|
||||
|
||||
res = platform_get_resource(usb_bam_pdev, IORESOURCE_MEM,
|
||||
pdata->usb_active_bam);
|
||||
if (!res) {
|
||||
dev_err(&usb_bam_pdev->dev, "Unable to get memory resource\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
irq = platform_get_irq(usb_bam_pdev, pdata->usb_active_bam);
|
||||
if (irq < 0) {
|
||||
dev_err(&usb_bam_pdev->dev, "Unable to get IRQ resource\n");
|
||||
return irq;
|
||||
}
|
||||
|
||||
usb_virt_addr = ioremap(res->start, resource_size(res));
|
||||
if (!usb_virt_addr) {
|
||||
pr_err("%s: ioremap failed\n", __func__);
|
||||
return -ENOMEM;
|
||||
}
|
||||
usb_props.phys_addr = res->start;
|
||||
usb_props.virt_addr = usb_virt_addr;
|
||||
usb_props.virt_size = resource_size(res);
|
||||
usb_props.irq = irq;
|
||||
usb_props.summing_threshold = USB_SUMMING_THRESHOLD;
|
||||
usb_props.num_pipes = pdata->usb_bam_num_pipes;
|
||||
|
||||
ret = sps_register_bam_device(&usb_props, &h_usb);
|
||||
if (ret < 0) {
|
||||
pr_err("%s: register bam error %d\n", __func__, ret);
|
||||
return -EFAULT;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static char *bam_enable_strings[2] = {
|
||||
[HSUSB_BAM] = "hsusb",
|
||||
[HSIC_BAM] = "hsic",
|
||||
};
|
||||
|
||||
static ssize_t
|
||||
usb_bam_show_enable(struct device *dev, struct device_attribute *attr,
|
||||
char *buf)
|
||||
{
|
||||
struct platform_device *pdev = container_of(dev, struct platform_device,
|
||||
dev);
|
||||
struct msm_usb_bam_platform_data *pdata =
|
||||
(struct msm_usb_bam_platform_data *)
|
||||
(usb_bam_pdev->dev.platform_data);
|
||||
|
||||
if (!pdev || !pdata)
|
||||
return 0;
|
||||
return scnprintf(buf, PAGE_SIZE, "%s\n",
|
||||
bam_enable_strings[pdata->usb_active_bam]);
|
||||
}
|
||||
|
||||
static ssize_t usb_bam_store_enable(struct device *dev,
|
||||
struct device_attribute *attr,
|
||||
const char *buf, size_t count)
|
||||
{
|
||||
struct platform_device *pdev = container_of(dev, struct platform_device,
|
||||
dev);
|
||||
struct msm_usb_bam_platform_data *pdata =
|
||||
(struct msm_usb_bam_platform_data *)
|
||||
(usb_bam_pdev->dev.platform_data);
|
||||
char str[10], *pstr;
|
||||
int ret, i;
|
||||
|
||||
strlcpy(str, buf, sizeof(str));
|
||||
pstr = strim(str);
|
||||
|
||||
for (i = 0; i < ARRAY_SIZE(bam_enable_strings); i++) {
|
||||
if (!strncmp(pstr, bam_enable_strings[i], sizeof(str)))
|
||||
pdata->usb_active_bam = i;
|
||||
}
|
||||
|
||||
dev_dbg(&pdev->dev, "active_bam=%s\n",
|
||||
bam_enable_strings[pdata->usb_active_bam]);
|
||||
|
||||
ret = usb_bam_init();
|
||||
if (ret) {
|
||||
dev_err(&pdev->dev, "failed to initialize usb bam\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
return count;
|
||||
}
|
||||
|
||||
static DEVICE_ATTR(enable, S_IWUSR | S_IRUSR, usb_bam_show_enable,
|
||||
usb_bam_store_enable);
|
||||
|
||||
static int usb_bam_probe(struct platform_device *pdev)
|
||||
{
|
||||
int ret, i;
|
||||
|
||||
dev_dbg(&pdev->dev, "usb_bam_probe\n");
|
||||
|
||||
for (i = 0; i < CONNECTIONS_NUM; i++) {
|
||||
usb_bam_connections[i].enabled = 0;
|
||||
INIT_WORK(&usb_bam_connections[i].peer_event.wake_w,
|
||||
usb_bam_wake_work);
|
||||
}
|
||||
|
||||
if (!pdev->dev.platform_data) {
|
||||
dev_err(&pdev->dev, "missing platform_data\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
usb_bam_pdev = pdev;
|
||||
|
||||
ret = device_create_file(&pdev->dev, &dev_attr_enable);
|
||||
if (ret)
|
||||
dev_err(&pdev->dev, "failed to create device file\n");
|
||||
|
||||
usb_bam_wq = alloc_workqueue("usb_bam_wq",
|
||||
WQ_UNBOUND | WQ_MEM_RECLAIM, 1);
|
||||
if (!usb_bam_wq) {
|
||||
pr_err("unable to create workqueue usb_bam_wq\n");
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int usb_bam_remove(struct platform_device *pdev)
|
||||
{
|
||||
destroy_workqueue(usb_bam_wq);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct platform_driver usb_bam_driver = {
|
||||
.probe = usb_bam_probe,
|
||||
.remove = usb_bam_remove,
|
||||
.driver = { .name = "usb_bam", },
|
||||
};
|
||||
|
||||
static int __init init(void)
|
||||
{
|
||||
return platform_driver_register(&usb_bam_driver);
|
||||
}
|
||||
module_init(init);
|
||||
|
||||
static void __exit cleanup(void)
|
||||
{
|
||||
platform_driver_unregister(&usb_bam_driver);
|
||||
}
|
||||
module_exit(cleanup);
|
||||
|
||||
MODULE_DESCRIPTION("MSM USB BAM DRIVER");
|
||||
MODULE_LICENSE("GPL v2");
|
||||
@@ -19,7 +19,25 @@
|
||||
#define __ASM_ARCH_MSM_HSUSB_H
|
||||
|
||||
#include <linux/types.h>
|
||||
#include <linux/usb/ch9.h>
|
||||
#include <linux/usb/gadget.h>
|
||||
#include <linux/usb/otg.h>
|
||||
#include <linux/pm_qos.h>
|
||||
|
||||
/*
|
||||
* The following are bit fields describing the usb_request.udc_priv word.
|
||||
* These bit fields are set by function drivers that wish to queue
|
||||
* usb_requests with sps/bam parameters.
|
||||
*/
|
||||
#define MSM_PIPE_ID_MASK (0x1F)
|
||||
#define MSM_TX_PIPE_ID_OFS (16)
|
||||
#define MSM_SPS_MODE BIT(5)
|
||||
#define MSM_IS_FINITE_TRANSFER BIT(6)
|
||||
#define MSM_PRODUCER BIT(7)
|
||||
#define MSM_DISABLE_WB BIT(8)
|
||||
#define MSM_ETD_IOC BIT(9)
|
||||
#define MSM_INTERNAL_MEM BIT(10)
|
||||
#define MSM_VENDOR_ID BIT(16)
|
||||
|
||||
/**
|
||||
* Supported USB modes
|
||||
@@ -116,7 +134,8 @@ enum usb_chg_type {
|
||||
* for msm_otg driver.
|
||||
* @phy_init_seq: PHY configuration sequence. val, reg pairs
|
||||
* terminated by -1.
|
||||
* @vbus_power: VBUS power on/off routine.
|
||||
* @vbus_power: VBUS power on/off routine.It should return result
|
||||
* as success(zero value) or failure(non-zero value).
|
||||
* @power_budget: VBUS power budget in mA (0 will be treated as 500mA).
|
||||
* @mode: Supported mode (OTG/peripheral/host).
|
||||
* @otg_control: OTG switch controlled by user/Id pin
|
||||
@@ -127,7 +146,7 @@ enum usb_chg_type {
|
||||
*/
|
||||
struct msm_otg_platform_data {
|
||||
int *phy_init_seq;
|
||||
void (*vbus_power)(bool on);
|
||||
int (*vbus_power)(bool on);
|
||||
unsigned power_budget;
|
||||
enum usb_mode_type mode;
|
||||
enum otg_control_type otg_control;
|
||||
@@ -182,4 +201,45 @@ struct msm_otg {
|
||||
u8 dcd_retries;
|
||||
};
|
||||
|
||||
struct msm_hsic_host_platform_data {
|
||||
unsigned strobe;
|
||||
unsigned data;
|
||||
struct msm_bus_scale_pdata *bus_scale_table;
|
||||
};
|
||||
|
||||
struct msm_usb_host_platform_data {
|
||||
unsigned int power_budget;
|
||||
unsigned int dock_connect_irq;
|
||||
};
|
||||
|
||||
struct msm_hsic_peripheral_platform_data {
|
||||
bool keep_core_clk_on_suspend_workaround;
|
||||
};
|
||||
|
||||
struct usb_bam_pipe_connect {
|
||||
u32 src_phy_addr;
|
||||
int src_pipe_index;
|
||||
u32 dst_phy_addr;
|
||||
int dst_pipe_index;
|
||||
u32 data_fifo_base_offset;
|
||||
u32 data_fifo_size;
|
||||
u32 desc_fifo_base_offset;
|
||||
u32 desc_fifo_size;
|
||||
};
|
||||
|
||||
struct msm_usb_bam_platform_data {
|
||||
struct usb_bam_pipe_connect *connections;
|
||||
int usb_active_bam;
|
||||
int usb_bam_num_pipes;
|
||||
};
|
||||
|
||||
enum usb_bam {
|
||||
HSUSB_BAM = 0,
|
||||
HSIC_BAM,
|
||||
};
|
||||
|
||||
int msm_ep_config(struct usb_ep *ep);
|
||||
int msm_ep_unconfig(struct usb_ep *ep);
|
||||
int msm_data_fifo_config(struct usb_ep *ep, u32 addr, u32 size);
|
||||
|
||||
#endif
|
||||
|
||||
Reference in New Issue
Block a user