greybus: es2: Add support for CSI transmitter configuration (8e2b7daa) · Commits · 戴 / test

drivers/staging/greybus/es2.c

+48 −0

Original line number	Diff line number	Diff line
		@@ -13,6 +13,7 @@
		#include <linux/debugfs.h>
		#include <asm/unaligned.h>

		#include "es2.h"
		#include "greybus.h"
		#include "kernel_ver.h"
		#include "connection.h"
		@@ -60,6 +61,9 @@ MODULE_DEVICE_TABLE(usb, id_table);
		#define REQUEST_LATENCY_TAG_EN 0x06
		#define REQUEST_LATENCY_TAG_DIS 0x07

		/* vendor request to control the CSI transmitter */
		#define REQUEST_CSI_TX_CONTROL 0x08

		/*
		* @endpoint: bulk in endpoint for CPort data
		* @urb: array of urbs for the CPort in messages
		@@ -130,6 +134,14 @@ struct cport_to_ep {
		__u8 endpoint_out;
		};

		struct es2_ap_csi_config_request {
		u8 csi_id;
		u8 clock_mode;
		u8 num_lanes;
		u8 padding;
		__le32 bus_freq;
		} __attribute__((__packed__));

		static inline struct es2_ap_dev hd_to_es2(struct gb_host_device hd)
		{
		return (struct es2_ap_dev *)&hd->hd_priv;
		@@ -208,6 +220,42 @@ static int unmap_cport(struct es2_ap_dev *es2, u16 cport_id)
		}
		#endif

		int es2_ap_csi_setup(struct gb_host_device *hd, bool start,
		struct es2_ap_csi_config *cfg)
		{
		struct es2_ap_csi_config_request cfg_req;
		struct es2_ap_dev *es2 = hd_to_es2(hd);
		struct usb_device *udev = es2->usb_dev;
		int retval;

		cfg_req.csi_id = cfg->csi_id;

		if (start) {
		cfg_req.clock_mode = cfg->clock_mode;
		cfg_req.num_lanes = cfg->num_lanes;
		cfg_req.padding = 0;
		cfg_req.bus_freq = cfg->bus_freq;
		} else {
		cfg_req.clock_mode = 0;
		cfg_req.num_lanes = 0;
		cfg_req.padding = 0;
		cfg_req.bus_freq = 0;
		}

		retval = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
		REQUEST_CSI_TX_CONTROL,
		USB_DIR_OUT \| USB_TYPE_VENDOR \|
		USB_RECIP_INTERFACE, 0, 0, &cfg_req,
		sizeof(cfg_req), ES2_TIMEOUT);
		if (retval < 0) {
		dev_err(&udev->dev, "failed to setup csi: %d\n", retval);
		return retval;
		}

		return 0;
		}
		EXPORT_SYMBOL_GPL(es2_ap_csi_setup);

		static int es2_cport_in_enable(struct es2_ap_dev *es2,
		struct es2_cport_in *cport_in)
		{

drivers/staging/greybus/es2.h

0 → 100644

+27 −0

Original line number	Diff line number	Diff line
		/*
		* Greybus "AP" USB driver for "ES2" controller chips
		*
		* Copyright 2015 Google Inc.
		* Copyright 2015 Linaro Ltd.
		*
		* Released under the GPLv2 only.
		*/

		#ifndef __ES2_H
		#define __ES2_H

		#include <linux/types.h>

		struct gb_host_device;

		struct es2_ap_csi_config {
		u8 csi_id;
		u8 clock_mode;
		u8 num_lanes;
		u32 bus_freq;
		};

		int es2_ap_csi_setup(struct gb_host_device *hd, bool start,
		struct es2_ap_csi_config *cfg);

		#endif /* __ES2_H */

Admin message