drivers/char/mst_ctrl.c

/*
 * @file mst_ctrl.c
 * @brief MST stop control node
 * Copyright (c) 2015, Samsung Electronics Corporation. 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/mm.h>
#include <linux/miscdevice.h>
#include <linux/slab.h>
#include <linux/vmalloc.h>
#include <linux/mman.h>
#include <linux/random.h>
#include <linux/init.h>
#include <linux/raw.h>
#include <linux/tty.h>
#include <linux/capability.h>
#include <linux/ptrace.h>
#include <linux/device.h>
#include <linux/highmem.h>
#include <linux/crash_dump.h>
#include <linux/backing-dev.h>
#include <linux/bootmem.h>
#include <linux/splice.h>
#include <linux/pfn.h>
#include <linux/export.h>
#include <linux/seq_file.h>
#include <linux/smc.h>

#include <asm/uaccess.h>
#include <asm/io.h>

#include <linux/delay.h>

/* Mar 9, 2016, limit the length of string to 1 byte: "0" or "1"*/
#define MST_CTRL_CMD_LEN ((size_t)1)

#define SMC_CMD_FC_NFC_ACTION ((uint32_t)(0x83000030))

ssize_t mst_ctrl_write(struct file *file, const char __user *buffer, size_t size, loff_t *offset) {

	unsigned long mode;
	char *string;
	int nfc_status;

	if (size == 0)
		return 0;

	printk(KERN_ERR " %s\n", __FUNCTION__);

	/* size includes space for NULL, so size will be "number of buffer char. + 1" */
	string = kmalloc(MST_CTRL_CMD_LEN + 1, GFP_KERNEL);
	if (string == NULL) {
		printk(KERN_ERR "%s failed kmalloc\n", __func__);
		return 0;
	}

	if (copy_from_user(string, buffer, MST_CTRL_CMD_LEN) != 0) {
		printk(KERN_ERR "%s failed copy_from_user\n", __func__);
		kfree(string);
		return 0;
	}

	string[MST_CTRL_CMD_LEN] = '\0';

	if(kstrtoul(string, 0, &mode)) {
		memset(string, 0, MST_CTRL_CMD_LEN);
		kfree(string);
		return 0;
	};

	memset(string, 0, MST_CTRL_CMD_LEN);
	kfree(string);

	printk(KERN_ERR "id: %d\n", (int)mode);

	switch(mode) {
		case 1:
			printk(KERN_ERR " %s -> Notify secure world that NFS starts.\n", __FUNCTION__);
			nfc_status = exynos_smc(SMC_CMD_FC_NFC_ACTION, 1, 0, 0);
			printk(KERN_ERR " %s -> value of nfc_status is %d.\n", __FUNCTION__, nfc_status);
			break;
		case 0:
			printk(KERN_ERR " %s -> Notify secure world that NFS ends.\n", __FUNCTION__);
			nfc_status = exynos_smc(SMC_CMD_FC_NFC_ACTION, 2, 0, 0);
			printk(KERN_ERR " %s -> value of nfc_status is %d.\n", __FUNCTION__, nfc_status);
			break;
		default:
			printk(KERN_ERR " %s -> Invalid mst operations\n", __FUNCTION__);
			break;
	}

	return size;
}

static int mst_ctrl_read(struct seq_file *m, void *v)
{
	return 0;
}
static int mst_ctrl_open(struct inode *inode, struct file *filp)
{
	return single_open(filp, mst_ctrl_read, NULL);
}

long mst_ctrl_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
{
	/* 
	 * Switch according to the ioctl called 
	 */
	switch (cmd) {
		case 1:
			printk(KERN_ERR " %s -> Notify secure world that NFS starts.\n", __FUNCTION__);
			exynos_smc(SMC_CMD_FC_NFC_ACTION, 0x1, 0, 0);
			break;
		case 0:
			printk(KERN_ERR " %s -> Notify secure world that NFS ends.\n", __FUNCTION__);
			exynos_smc(SMC_CMD_FC_NFC_ACTION, 0x2, 0, 0);
			break;
		default:
			printk(KERN_ERR " %s -> Invalid mst ctrl operations\n", __FUNCTION__);
			return -1;
			break;
	}

	return 0;
}

const struct file_operations mst_ctrl_fops = {
	.open	= mst_ctrl_open,
	.release	= single_release,
	.read	= seq_read,
	.write	= mst_ctrl_write,
	.unlocked_ioctl  = mst_ctrl_ioctl,
};