drivers/staging/fsl-mc/bus/dpcon.c - arm/linux - Git at Google

 /* Copyright 2013-2016 Freescale Semiconductor Inc.
  *
  * Redistribution and use in source and binary forms, with or without
  * modification, are permitted provided that the following conditions are met:
  * * Redistributions of source code must retain the above copyright
  * notice, this list of conditions and the following disclaimer.
  * * Redistributions in binary form must reproduce the above copyright
  * notice, this list of conditions and the following disclaimer in the
  * documentation and/or other materials provided with the distribution.
  * * Neither the name of the above-listed copyright holders nor the
  * names of any contributors may be used to endorse or promote products
  * derived from this software without specific prior written permission.
  *
  *
  * ALTERNATIVELY, this software may be distributed under the terms of the
  * GNU General Public License ("GPL") as published by the Free Software
  * Foundation, either version 2 of that License or (at your option) any
  * later version.
  *
  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE
  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  * POSSIBILITY OF SUCH DAMAGE.
  */
 #include <linux/kernel.h>
 #include "../include/mc.h"
 #include "../include/dpcon.h"

 #include "dpcon-cmd.h"

 /**
  * dpcon_open() - Open a control session for the specified object
  * @mc_io:	Pointer to MC portal's I/O object
  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
  * @dpcon_id:	DPCON unique ID
  * @token:	Returned token; use in subsequent API calls
  *
  * This function can be used to open a control session for an
  * already created object; an object may have been declared in
  * the DPL or by calling the dpcon_create() function.
  * This function returns a unique authentication token,
  * associated with the specific object ID and the specific MC
  * portal; this token must be used in all subsequent commands for
  * this specific object.
  *
  * Return:	'0' on Success; Error code otherwise.
  */
 int dpcon_open(struct fsl_mc_io *mc_io,
 	       u32 cmd_flags,
 	       int dpcon_id,
 	       u16 *token)
 {
 	struct mc_command cmd = { 0 };
 	struct dpcon_cmd_open *dpcon_cmd;
 	int err;

 	/* prepare command */
 	cmd.header = mc_encode_cmd_header(DPCON_CMDID_OPEN,
 					  cmd_flags,
 					  0);
 	dpcon_cmd = (struct dpcon_cmd_open *)cmd.params;
 	dpcon_cmd->dpcon_id = cpu_to_le32(dpcon_id);

 	/* send command to mc*/
 	err = mc_send_command(mc_io, &cmd);
 	if (err)
 		return err;

 	/* retrieve response parameters */
 	*token = mc_cmd_hdr_read_token(&cmd);

 	return 0;
 }
 EXPORT_SYMBOL(dpcon_open);

 /**
  * dpcon_close() - Close the control session of the object
  * @mc_io:	Pointer to MC portal's I/O object
  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
  * @token:	Token of DPCON object
  *
  * After this function is called, no further operations are
  * allowed on the object without opening a new control session.
  *
  * Return:	'0' on Success; Error code otherwise.
  */
 int dpcon_close(struct fsl_mc_io *mc_io,
 		u32 cmd_flags,
 		u16 token)
 {
 	struct mc_command cmd = { 0 };

 	/* prepare command */
 	cmd.header = mc_encode_cmd_header(DPCON_CMDID_CLOSE,
 					  cmd_flags,
 					  token);

 	/* send command to mc*/
 	return mc_send_command(mc_io, &cmd);
 }
 EXPORT_SYMBOL(dpcon_close);

 /**
  * dpcon_enable() - Enable the DPCON
  * @mc_io:	Pointer to MC portal's I/O object
  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
  * @token:	Token of DPCON object
  *
  * Return:	'0' on Success; Error code otherwise
  */
 int dpcon_enable(struct fsl_mc_io *mc_io,
 		 u32 cmd_flags,
 		 u16 token)
 {
 	struct mc_command cmd = { 0 };

 	/* prepare command */
 	cmd.header = mc_encode_cmd_header(DPCON_CMDID_ENABLE,
 					  cmd_flags,
 					  token);

 	/* send command to mc*/
 	return mc_send_command(mc_io, &cmd);
 }
 EXPORT_SYMBOL(dpcon_enable);

 /**
  * dpcon_disable() - Disable the DPCON
  * @mc_io:	Pointer to MC portal's I/O object
  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
  * @token:	Token of DPCON object
  *
  * Return:	'0' on Success; Error code otherwise
  */
 int dpcon_disable(struct fsl_mc_io *mc_io,
 		  u32 cmd_flags,
 		  u16 token)
 {
 	struct mc_command cmd = { 0 };

 	/* prepare command */
 	cmd.header = mc_encode_cmd_header(DPCON_CMDID_DISABLE,
 					  cmd_flags,
 					  token);

 	/* send command to mc*/
 	return mc_send_command(mc_io, &cmd);
 }
 EXPORT_SYMBOL(dpcon_disable);

 /**
  * dpcon_is_enabled() -	Check if the DPCON is enabled.
  * @mc_io:	Pointer to MC portal's I/O object
  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
  * @token:	Token of DPCON object
  * @en:		Returns '1' if object is enabled; '0' otherwise
  *
  * Return:	'0' on Success; Error code otherwise.
  */
 int dpcon_is_enabled(struct fsl_mc_io *mc_io,
 		     u32 cmd_flags,
 		     u16 token,
 		     int *en)
 {
 	struct mc_command cmd = { 0 };
 	struct dpcon_rsp_is_enabled *dpcon_rsp;
 	int err;

 	/* prepare command */
 	cmd.header = mc_encode_cmd_header(DPCON_CMDID_IS_ENABLED,
 					  cmd_flags,
 					  token);

 	/* send command to mc*/
 	err = mc_send_command(mc_io, &cmd);
 	if (err)
 		return err;

 	/* retrieve response parameters */
 	dpcon_rsp = (struct dpcon_rsp_is_enabled *)cmd.params;
 	*en = dpcon_rsp->enabled & DPCON_ENABLE;

 	return 0;
 }
 EXPORT_SYMBOL(dpcon_is_enabled);

 /**
  * dpcon_reset() - Reset the DPCON, returns the object to initial state.
  * @mc_io:	Pointer to MC portal's I/O object
  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
  * @token:	Token of DPCON object
  *
  * Return:	'0' on Success; Error code otherwise.
  */
 int dpcon_reset(struct fsl_mc_io *mc_io,
 		u32 cmd_flags,
 		u16 token)
 {
 	struct mc_command cmd = { 0 };

 	/* prepare command */
 	cmd.header = mc_encode_cmd_header(DPCON_CMDID_RESET,
 					  cmd_flags, token);

 	/* send command to mc*/
 	return mc_send_command(mc_io, &cmd);
 }
 EXPORT_SYMBOL(dpcon_reset);

 /**
  * dpcon_get_attributes() - Retrieve DPCON attributes.
  * @mc_io:	Pointer to MC portal's I/O object
  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
  * @token:	Token of DPCON object
  * @attr:	Object's attributes
  *
  * Return:	'0' on Success; Error code otherwise.
  */
 int dpcon_get_attributes(struct fsl_mc_io *mc_io,
 			 u32 cmd_flags,
 			 u16 token,
 			 struct dpcon_attr *attr)
 {
 	struct mc_command cmd = { 0 };
 	struct dpcon_rsp_get_attr *dpcon_rsp;
 	int err;

 	/* prepare command */
 	cmd.header = mc_encode_cmd_header(DPCON_CMDID_GET_ATTR,
 					  cmd_flags,
 					  token);

 	/* send command to mc*/
 	err = mc_send_command(mc_io, &cmd);
 	if (err)
 		return err;

 	/* retrieve response parameters */
 	dpcon_rsp = (struct dpcon_rsp_get_attr *)cmd.params;
 	attr->id = le32_to_cpu(dpcon_rsp->id);
 	attr->qbman_ch_id = le16_to_cpu(dpcon_rsp->qbman_ch_id);
 	attr->num_priorities = dpcon_rsp->num_priorities;

 	return 0;
 }
 EXPORT_SYMBOL(dpcon_get_attributes);

 /**
  * dpcon_set_notification() - Set DPCON notification destination
  * @mc_io:	Pointer to MC portal's I/O object
  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
  * @token:	Token of DPCON object
  * @cfg:	Notification parameters
  *
  * Return:	'0' on Success; Error code otherwise
  */
 int dpcon_set_notification(struct fsl_mc_io *mc_io,
 			   u32 cmd_flags,
 			   u16 token,
 			   struct dpcon_notification_cfg *cfg)
 {
 	struct mc_command cmd = { 0 };
 	struct dpcon_cmd_set_notification *dpcon_cmd;

 	/* prepare command */
 	cmd.header = mc_encode_cmd_header(DPCON_CMDID_SET_NOTIFICATION,
 					  cmd_flags,
 					  token);
 	dpcon_cmd = (struct dpcon_cmd_set_notification *)cmd.params;
 	dpcon_cmd->dpio_id = cpu_to_le32(cfg->dpio_id);
 	dpcon_cmd->priority = cfg->priority;
 	dpcon_cmd->user_ctx = cpu_to_le64(cfg->user_ctx);

 	/* send command to mc*/
 	return mc_send_command(mc_io, &cmd);
 }
 EXPORT_SYMBOL(dpcon_set_notification);

 /**
  * dpcon_get_api_version - Get Data Path Concentrator API version
  * @mc_io:	Pointer to MC portal's DPCON object
  * @cmd_flags:	Command flags; one or more of 'MC_CMD_FLAG_'
  * @major_ver:	Major version of DPCON API
  * @minor_ver:	Minor version of DPCON API
  *
  * Return:	'0' on Success; Error code otherwise
  */
 int dpcon_get_api_version(struct fsl_mc_io *mc_io,
 			  u32 cmd_flags,
 			  u16 *major_ver,
 			  u16 *minor_ver)
 {
 	struct mc_command cmd = { 0 };
 	int err;

 	/* prepare command */
 	cmd.header = mc_encode_cmd_header(DPCON_CMDID_GET_API_VERSION,
 					  cmd_flags, 0);

 	/* send command to mc */
 	err = mc_send_command(mc_io, &cmd);
 	if (err)
 		return err;

 	/* retrieve response parameters */
 	mc_cmd_read_api_version(&cmd, major_ver, minor_ver);

 	return 0;
 }
 EXPORT_SYMBOL(dpcon_get_api_version);
	/* Copyright 2013-2016 Freescale Semiconductor Inc.
	*
	* Redistribution and use in source and binary forms, with or without
	* modification, are permitted provided that the following conditions are met:
	* * Redistributions of source code must retain the above copyright
	* notice, this list of conditions and the following disclaimer.
	* * Redistributions in binary form must reproduce the above copyright
	* notice, this list of conditions and the following disclaimer in the
	* documentation and/or other materials provided with the distribution.
	* * Neither the name of the above-listed copyright holders nor the
	* names of any contributors may be used to endorse or promote products
	* derived from this software without specific prior written permission.
	*
	*
	* ALTERNATIVELY, this software may be distributed under the terms of the
	* GNU General Public License ("GPL") as published by the Free Software
	* Foundation, either version 2 of that License or (at your option) any
	* later version.
	*
	* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
	* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
	* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
	* ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE
	* LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
	* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
	* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
	* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
	* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
	* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
	* POSSIBILITY OF SUCH DAMAGE.
	*/
	#include <linux/kernel.h>
	#include "../include/mc.h"
	#include "../include/dpcon.h"

	#include "dpcon-cmd.h"

	/**
	* dpcon_open() - Open a control session for the specified object
	* @mc_io: Pointer to MC portal's I/O object
	* @cmd_flags: Command flags; one or more of 'MC_CMD_FLAG_'
	* @dpcon_id: DPCON unique ID
	* @token: Returned token; use in subsequent API calls
	*
	* This function can be used to open a control session for an
	* already created object; an object may have been declared in
	* the DPL or by calling the dpcon_create() function.
	* This function returns a unique authentication token,
	* associated with the specific object ID and the specific MC
	* portal; this token must be used in all subsequent commands for
	* this specific object.
	*
	* Return: '0' on Success; Error code otherwise.
	*/
	int dpcon_open(struct fsl_mc_io *mc_io,
	u32 cmd_flags,
	int dpcon_id,
	u16 *token)
	{
	struct mc_command cmd = { 0 };
	struct dpcon_cmd_open *dpcon_cmd;
	int err;

	/* prepare command */
	cmd.header = mc_encode_cmd_header(DPCON_CMDID_OPEN,
	cmd_flags,
	0);
	dpcon_cmd = (struct dpcon_cmd_open *)cmd.params;
	dpcon_cmd->dpcon_id = cpu_to_le32(dpcon_id);

	/* send command to mc*/
	err = mc_send_command(mc_io, &cmd);
	if (err)
	return err;

	/* retrieve response parameters */
	*token = mc_cmd_hdr_read_token(&cmd);

	return 0;
	}
	EXPORT_SYMBOL(dpcon_open);

	/**
	* dpcon_close() - Close the control session of the object
	* @mc_io: Pointer to MC portal's I/O object
	* @cmd_flags: Command flags; one or more of 'MC_CMD_FLAG_'
	* @token: Token of DPCON object
	*
	* After this function is called, no further operations are
	* allowed on the object without opening a new control session.
	*
	* Return: '0' on Success; Error code otherwise.
	*/
	int dpcon_close(struct fsl_mc_io *mc_io,
	u32 cmd_flags,
	u16 token)
	{
	struct mc_command cmd = { 0 };

	/* prepare command */
	cmd.header = mc_encode_cmd_header(DPCON_CMDID_CLOSE,
	cmd_flags,
	token);

	/* send command to mc*/
	return mc_send_command(mc_io, &cmd);
	}
	EXPORT_SYMBOL(dpcon_close);

	/**
	* dpcon_enable() - Enable the DPCON
	* @mc_io: Pointer to MC portal's I/O object
	* @cmd_flags: Command flags; one or more of 'MC_CMD_FLAG_'
	* @token: Token of DPCON object
	*
	* Return: '0' on Success; Error code otherwise
	*/
	int dpcon_enable(struct fsl_mc_io *mc_io,
	u32 cmd_flags,
	u16 token)
	{
	struct mc_command cmd = { 0 };

	/* prepare command */
	cmd.header = mc_encode_cmd_header(DPCON_CMDID_ENABLE,
	cmd_flags,
	token);

	/* send command to mc*/
	return mc_send_command(mc_io, &cmd);
	}
	EXPORT_SYMBOL(dpcon_enable);

	/**
	* dpcon_disable() - Disable the DPCON
	* @mc_io: Pointer to MC portal's I/O object
	* @cmd_flags: Command flags; one or more of 'MC_CMD_FLAG_'
	* @token: Token of DPCON object
	*
	* Return: '0' on Success; Error code otherwise
	*/
	int dpcon_disable(struct fsl_mc_io *mc_io,
	u32 cmd_flags,
	u16 token)
	{
	struct mc_command cmd = { 0 };

	/* prepare command */
	cmd.header = mc_encode_cmd_header(DPCON_CMDID_DISABLE,
	cmd_flags,
	token);

	/* send command to mc*/
	return mc_send_command(mc_io, &cmd);
	}
	EXPORT_SYMBOL(dpcon_disable);

	/**
	* dpcon_is_enabled() - Check if the DPCON is enabled.
	* @mc_io: Pointer to MC portal's I/O object
	* @cmd_flags: Command flags; one or more of 'MC_CMD_FLAG_'
	* @token: Token of DPCON object
	* @en: Returns '1' if object is enabled; '0' otherwise
	*
	* Return: '0' on Success; Error code otherwise.
	*/
	int dpcon_is_enabled(struct fsl_mc_io *mc_io,
	u32 cmd_flags,
	u16 token,
	int *en)
	{
	struct mc_command cmd = { 0 };
	struct dpcon_rsp_is_enabled *dpcon_rsp;
	int err;

	/* prepare command */
	cmd.header = mc_encode_cmd_header(DPCON_CMDID_IS_ENABLED,
	cmd_flags,
	token);

	/* send command to mc*/
	err = mc_send_command(mc_io, &cmd);
	if (err)
	return err;

	/* retrieve response parameters */
	dpcon_rsp = (struct dpcon_rsp_is_enabled *)cmd.params;
	*en = dpcon_rsp->enabled & DPCON_ENABLE;

	return 0;
	}
	EXPORT_SYMBOL(dpcon_is_enabled);

	/**
	* dpcon_reset() - Reset the DPCON, returns the object to initial state.
	* @mc_io: Pointer to MC portal's I/O object
	* @cmd_flags: Command flags; one or more of 'MC_CMD_FLAG_'
	* @token: Token of DPCON object
	*
	* Return: '0' on Success; Error code otherwise.
	*/
	int dpcon_reset(struct fsl_mc_io *mc_io,
	u32 cmd_flags,
	u16 token)
	{
	struct mc_command cmd = { 0 };

	/* prepare command */
	cmd.header = mc_encode_cmd_header(DPCON_CMDID_RESET,
	cmd_flags, token);

	/* send command to mc*/
	return mc_send_command(mc_io, &cmd);
	}
	EXPORT_SYMBOL(dpcon_reset);

	/**
	* dpcon_get_attributes() - Retrieve DPCON attributes.
	* @mc_io: Pointer to MC portal's I/O object
	* @cmd_flags: Command flags; one or more of 'MC_CMD_FLAG_'
	* @token: Token of DPCON object
	* @attr: Object's attributes
	*
	* Return: '0' on Success; Error code otherwise.
	*/
	int dpcon_get_attributes(struct fsl_mc_io *mc_io,
	u32 cmd_flags,
	u16 token,
	struct dpcon_attr *attr)
	{
	struct mc_command cmd = { 0 };
	struct dpcon_rsp_get_attr *dpcon_rsp;
	int err;

	/* prepare command */
	cmd.header = mc_encode_cmd_header(DPCON_CMDID_GET_ATTR,
	cmd_flags,
	token);

	/* send command to mc*/
	err = mc_send_command(mc_io, &cmd);
	if (err)
	return err;

	/* retrieve response parameters */
	dpcon_rsp = (struct dpcon_rsp_get_attr *)cmd.params;
	attr->id = le32_to_cpu(dpcon_rsp->id);
	attr->qbman_ch_id = le16_to_cpu(dpcon_rsp->qbman_ch_id);
	attr->num_priorities = dpcon_rsp->num_priorities;

	return 0;
	}
	EXPORT_SYMBOL(dpcon_get_attributes);

	/**
	* dpcon_set_notification() - Set DPCON notification destination
	* @mc_io: Pointer to MC portal's I/O object
	* @cmd_flags: Command flags; one or more of 'MC_CMD_FLAG_'
	* @token: Token of DPCON object
	* @cfg: Notification parameters
	*
	* Return: '0' on Success; Error code otherwise
	*/
	int dpcon_set_notification(struct fsl_mc_io *mc_io,
	u32 cmd_flags,
	u16 token,
	struct dpcon_notification_cfg *cfg)
	{
	struct mc_command cmd = { 0 };
	struct dpcon_cmd_set_notification *dpcon_cmd;

	/* prepare command */
	cmd.header = mc_encode_cmd_header(DPCON_CMDID_SET_NOTIFICATION,
	cmd_flags,
	token);
	dpcon_cmd = (struct dpcon_cmd_set_notification *)cmd.params;
	dpcon_cmd->dpio_id = cpu_to_le32(cfg->dpio_id);
	dpcon_cmd->priority = cfg->priority;
	dpcon_cmd->user_ctx = cpu_to_le64(cfg->user_ctx);

	/* send command to mc*/
	return mc_send_command(mc_io, &cmd);
	}
	EXPORT_SYMBOL(dpcon_set_notification);

	/**
	* dpcon_get_api_version - Get Data Path Concentrator API version
	* @mc_io: Pointer to MC portal's DPCON object
	* @cmd_flags: Command flags; one or more of 'MC_CMD_FLAG_'
	* @major_ver: Major version of DPCON API
	* @minor_ver: Minor version of DPCON API
	*
	* Return: '0' on Success; Error code otherwise
	*/
	int dpcon_get_api_version(struct fsl_mc_io *mc_io,
	u32 cmd_flags,
	u16 *major_ver,
	u16 *minor_ver)
	{
	struct mc_command cmd = { 0 };
	int err;

	/* prepare command */
	cmd.header = mc_encode_cmd_header(DPCON_CMDID_GET_API_VERSION,
	cmd_flags, 0);

	/* send command to mc */
	err = mc_send_command(mc_io, &cmd);
	if (err)
	return err;

	/* retrieve response parameters */
	mc_cmd_read_api_version(&cmd, major_ver, minor_ver);

	return 0;
	}
	EXPORT_SYMBOL(dpcon_get_api_version);