2015-06-22 05:12:26 -06:00
|
|
|
/*
|
|
|
|
* Greybus CPort control protocol.
|
|
|
|
*
|
|
|
|
* Copyright 2015 Google Inc.
|
|
|
|
* Copyright 2015 Linaro Ltd.
|
|
|
|
*
|
|
|
|
* Released under the GPLv2 only.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <linux/kernel.h>
|
|
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/slab.h>
|
|
|
|
#include "greybus.h"
|
|
|
|
|
|
|
|
/* Get Manifest's size from the interface */
|
|
|
|
int gb_control_get_manifest_size_operation(struct gb_interface *intf)
|
|
|
|
{
|
|
|
|
struct gb_control_get_manifest_size_response response;
|
|
|
|
struct gb_connection *connection = intf->control->connection;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
ret = gb_operation_sync(connection, GB_CONTROL_TYPE_GET_MANIFEST_SIZE,
|
|
|
|
NULL, 0, &response, sizeof(response));
|
|
|
|
if (ret) {
|
2015-11-25 07:59:23 -07:00
|
|
|
dev_err(&connection->intf->dev,
|
|
|
|
"failed to get manifest size: %d\n", ret);
|
2015-06-22 05:12:26 -06:00
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
return le16_to_cpu(response.size);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Reads Manifest from the interface */
|
|
|
|
int gb_control_get_manifest_operation(struct gb_interface *intf, void *manifest,
|
|
|
|
size_t size)
|
|
|
|
{
|
|
|
|
struct gb_connection *connection = intf->control->connection;
|
|
|
|
|
|
|
|
return gb_operation_sync(connection, GB_CONTROL_TYPE_GET_MANIFEST,
|
|
|
|
NULL, 0, manifest, size);
|
|
|
|
}
|
|
|
|
|
|
|
|
int gb_control_connected_operation(struct gb_control *control, u16 cport_id)
|
|
|
|
{
|
|
|
|
struct gb_control_connected_request request;
|
|
|
|
|
|
|
|
request.cport_id = cpu_to_le16(cport_id);
|
|
|
|
return gb_operation_sync(control->connection, GB_CONTROL_TYPE_CONNECTED,
|
|
|
|
&request, sizeof(request), NULL, 0);
|
|
|
|
}
|
|
|
|
|
|
|
|
int gb_control_disconnected_operation(struct gb_control *control, u16 cport_id)
|
|
|
|
{
|
|
|
|
struct gb_control_disconnected_request request;
|
|
|
|
|
|
|
|
request.cport_id = cpu_to_le16(cport_id);
|
|
|
|
return gb_operation_sync(control->connection,
|
|
|
|
GB_CONTROL_TYPE_DISCONNECTED, &request,
|
|
|
|
sizeof(request), NULL, 0);
|
|
|
|
}
|
|
|
|
|
2015-12-15 07:28:56 -07:00
|
|
|
struct gb_control *gb_control_create(struct gb_interface *intf)
|
2015-06-22 05:12:26 -06:00
|
|
|
{
|
|
|
|
struct gb_control *control;
|
|
|
|
|
|
|
|
control = kzalloc(sizeof(*control), GFP_KERNEL);
|
|
|
|
if (!control)
|
2015-12-15 07:28:56 -07:00
|
|
|
return NULL;
|
|
|
|
|
|
|
|
control->connection = gb_connection_create_dynamic(intf, NULL,
|
|
|
|
GB_CONTROL_CPORT_ID,
|
|
|
|
GREYBUS_PROTOCOL_CONTROL);
|
|
|
|
if (!control->connection) {
|
|
|
|
dev_err(&intf->dev, "failed to create control connection\n");
|
|
|
|
kfree(control);
|
|
|
|
return NULL;
|
|
|
|
}
|
2015-06-22 05:12:26 -06:00
|
|
|
|
2015-12-15 07:28:56 -07:00
|
|
|
control->connection->private = control;
|
|
|
|
|
|
|
|
return control;
|
|
|
|
}
|
|
|
|
|
|
|
|
int gb_control_enable(struct gb_control *control)
|
|
|
|
{
|
|
|
|
int ret;
|
2015-06-22 05:12:26 -06:00
|
|
|
|
2015-12-15 07:28:56 -07:00
|
|
|
dev_dbg(&control->connection->intf->dev, "%s\n", __func__);
|
|
|
|
|
|
|
|
ret = gb_connection_init(control->connection);
|
|
|
|
if (ret) {
|
|
|
|
dev_err(&control->connection->intf->dev,
|
|
|
|
"failed to enable control connection: %d\n",
|
|
|
|
ret);
|
|
|
|
return ret;
|
|
|
|
}
|
2015-06-22 05:12:26 -06:00
|
|
|
|
2015-08-10 20:06:02 -06:00
|
|
|
return 0;
|
2015-06-22 05:12:26 -06:00
|
|
|
}
|
|
|
|
|
2015-12-15 07:28:56 -07:00
|
|
|
void gb_control_disable(struct gb_control *control)
|
2015-06-22 05:12:26 -06:00
|
|
|
{
|
2015-12-15 07:28:56 -07:00
|
|
|
dev_dbg(&control->connection->intf->dev, "%s\n", __func__);
|
2015-06-22 05:12:26 -06:00
|
|
|
|
2015-12-15 07:28:56 -07:00
|
|
|
gb_connection_exit(control->connection);
|
|
|
|
}
|
|
|
|
|
|
|
|
void gb_control_destroy(struct gb_control *control)
|
|
|
|
{
|
|
|
|
gb_connection_destroy(control->connection);
|
2015-06-22 05:12:26 -06:00
|
|
|
kfree(control);
|
|
|
|
}
|
|
|
|
|
2015-12-15 07:28:56 -07:00
|
|
|
static int gb_control_connection_init(struct gb_connection *connection)
|
|
|
|
{
|
|
|
|
dev_dbg(&connection->intf->dev, "%s\n", __func__);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void gb_control_connection_exit(struct gb_connection *connection)
|
|
|
|
{
|
|
|
|
dev_dbg(&connection->intf->dev, "%s\n", __func__);
|
|
|
|
}
|
|
|
|
|
2015-06-22 05:12:26 -06:00
|
|
|
static struct gb_protocol control_protocol = {
|
|
|
|
.name = "control",
|
|
|
|
.id = GREYBUS_PROTOCOL_CONTROL,
|
2015-12-16 03:59:29 -07:00
|
|
|
.major = GB_CONTROL_VERSION_MAJOR,
|
|
|
|
.minor = GB_CONTROL_VERSION_MINOR,
|
2015-06-22 05:12:26 -06:00
|
|
|
.connection_init = gb_control_connection_init,
|
|
|
|
.connection_exit = gb_control_connection_exit,
|
2015-09-07 04:31:24 -06:00
|
|
|
.flags = GB_PROTOCOL_SKIP_CONTROL_CONNECTED |
|
|
|
|
GB_PROTOCOL_SKIP_CONTROL_DISCONNECTED,
|
2015-06-22 05:12:26 -06:00
|
|
|
};
|
2015-07-01 00:43:53 -06:00
|
|
|
gb_builtin_protocol_driver(control_protocol);
|