351 lines
7.1 KiB
C
351 lines
7.1 KiB
C
/*
|
|
Datasheet : http://ww1.microchip.com/downloads/en/DeviceDoc/
|
|
00001909A.pdf
|
|
*/
|
|
#include <linux/init.h>
|
|
#include <linux/module.h>
|
|
#include <linux/fs.h>
|
|
#include <linux/spi/spi.h>
|
|
#include <linux/uaccess.h>
|
|
#include <linux/miscdevice.h>
|
|
|
|
#define LAN9252_MAGIC 'l' //8bit=0~0xff 'l'an9252
|
|
#define TEST _IO(LAN9252_MAGIC, 0)
|
|
|
|
#define LAN9252_LOCK mutex_lock(&lan9252_mutex);
|
|
#define LAN9252_UNLOCK mutex_unlock(&lan9252_mutex);
|
|
|
|
#define DEVICE_NAME "lan9252"
|
|
|
|
/* spi command */
|
|
#define FAST_READ 0x0B
|
|
#define FAST_READ_DUMMY 1
|
|
|
|
struct mutex lock;
|
|
static DEFINE_MUTEX(lan9252_mutex);
|
|
|
|
static struct spi_device *lan9252;
|
|
|
|
static int lan9252_ethercat_probe(struct spi_device *spi);
|
|
static int lan9252_ethercat_remove(struct spi_device *spi);
|
|
|
|
static loff_t lan9252_llseek(struct file *file, loff_t address, int whence)
|
|
{
|
|
int ret;
|
|
|
|
LAN9252_LOCK;
|
|
|
|
file->f_pos = address;
|
|
ret = file->f_pos;
|
|
|
|
LAN9252_UNLOCK;
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int * lan9252_reg_addr_make(int address)
|
|
{
|
|
int temp;
|
|
static int lan9252_reg_addr[2];
|
|
#ifdef DEBUG
|
|
int i;
|
|
#endif
|
|
|
|
temp = address & 0xff00;
|
|
lan9252_reg_addr[0] = temp >> 8;
|
|
temp = address & 0x00ff;
|
|
lan9252_reg_addr[1] = temp;
|
|
|
|
#ifdef DEBUG
|
|
for (i=0; i<2; i++)
|
|
dev_dbg(&lan9252->dev, "%s() lan9252_reg_addr[%d] = 0x%x\n",
|
|
__FUNCTION__, i, lan9252_reg_addr[i]);
|
|
#endif
|
|
|
|
return lan9252_reg_addr;
|
|
}
|
|
|
|
/*
|
|
int lan9252_test(void);
|
|
Description : Check the connection status of LAN9252
|
|
Retrun Value
|
|
0 : success
|
|
other : fail
|
|
|
|
Register Type : SYSTEM CONTROL AND STATUS REGISTERS
|
|
Register Name(SYMBOL) : BYTE ORDER TEST REGISTER(BYTE_TEST)
|
|
Offset : 0x0064
|
|
Size : 32bit
|
|
Default : 0x87654321
|
|
Datasheet description : Chip-level reset/configuration
|
|
completion can be determined by first
|
|
polling the
|
|
Byte Order Test Register(BYTE_TEST).
|
|
*/
|
|
static int lan9252_test(void)
|
|
{
|
|
u8 command[4];
|
|
u8 test_buffer[4];
|
|
int ret=0;
|
|
#ifdef DEBUG
|
|
int i;
|
|
#endif
|
|
command[0]=FAST_READ;
|
|
command[1]=0x00;
|
|
command[2]=0x64;
|
|
command[3]=FAST_READ_DUMMY;
|
|
|
|
ret = spi_write_then_read(lan9252, &command, sizeof(command),
|
|
test_buffer, sizeof(test_buffer));
|
|
if (ret < 0 ) {
|
|
dev_err(&lan9252->dev, "%s() spi_write_then_read failed "
|
|
"ret=%d\n", __FUNCTION__, ret);
|
|
return -1;
|
|
}
|
|
|
|
ret = spi_write_then_read(lan9252, &command, sizeof(command),
|
|
test_buffer, sizeof(test_buffer));
|
|
if (ret < 0) {
|
|
dev_err(&lan9252->dev, "%s() spi_write_then_read failed "
|
|
"ret=%d\n", __FUNCTION__, ret);
|
|
return -1;
|
|
}
|
|
|
|
#ifdef DEBUG
|
|
for (i=0; i<sizeof(test_buffer); i++)
|
|
dev_dbg(&lan9252->dev, "%s() test_buffer[%d] = 0x%x\n",
|
|
__FUNCTION__, i, test_buffer[i]);
|
|
#endif
|
|
|
|
if (test_buffer[0]==0x21 && test_buffer[1]==0x43 &&
|
|
test_buffer[2]==0x65 && test_buffer[3]==0x87)
|
|
return 0;
|
|
else
|
|
return -1;
|
|
}
|
|
|
|
static ssize_t lan9252_read(struct file *file, char *buffer,
|
|
size_t read_buffer_size, loff_t *f_pos)
|
|
{
|
|
u8 command[4];
|
|
u8 *read_buffer;
|
|
int ret = 0;
|
|
int *lan9252_reg_read_addr;
|
|
#ifdef DEBUG
|
|
int i;
|
|
#endif
|
|
|
|
LAN9252_LOCK;
|
|
|
|
if (read_buffer_size <= 0) {
|
|
dev_err(&lan9252->dev, "read_buffer_size(%d) <= 0 \n",
|
|
read_buffer_size);
|
|
goto out;
|
|
} else {
|
|
dev_dbg(&lan9252->dev, "read_buffer_size = %d\n",
|
|
read_buffer_size);
|
|
}
|
|
|
|
read_buffer= (u8 *)kmalloc((read_buffer_size) * sizeof(u32),
|
|
GFP_KERNEL | GFP_DMA);
|
|
if (!read_buffer) {
|
|
dev_err(&lan9252->dev, "write read_buffer kmalloc error\n");
|
|
ret = -ENOMEM;
|
|
goto out;
|
|
}
|
|
|
|
memset(read_buffer, 0, (read_buffer_size) * sizeof(u8));
|
|
|
|
lan9252_reg_read_addr = lan9252_reg_addr_make(file->f_pos);
|
|
command[0] = FAST_READ;
|
|
command[1] = lan9252_reg_read_addr[0];
|
|
command[2] = lan9252_reg_read_addr[1];
|
|
command[3] = FAST_READ_DUMMY;
|
|
|
|
#ifdef DEBUG
|
|
for (i=0; i<4; i++)
|
|
dev_dbg(&lan9252->dev, "%s() command[%d] = 0x%x\n",
|
|
__FUNCTION__, i, command[i]);
|
|
#endif
|
|
|
|
ret = spi_write_then_read(lan9252, &command, sizeof(command),
|
|
read_buffer,read_buffer_size);
|
|
if (ret < 0) {
|
|
dev_err(&lan9252->dev, "%s() spi_write_then_read failed "
|
|
"ret=%d\n", __FUNCTION__, ret);
|
|
goto kfree_read_buffer;
|
|
}
|
|
|
|
#ifdef DEBUG
|
|
for (i=0; i<read_buffer_size; i++)
|
|
dev_dbg(&lan9252->dev, "%s() read_buffer[%d] = 0x%x\n",
|
|
__FUNCTION__, i, read_buffer[i]);
|
|
#endif
|
|
|
|
if (copy_to_user(buffer, read_buffer, read_buffer_size)) {
|
|
dev_err(&lan9252->dev, "%s() copy_to_user failed\n",
|
|
__FUNCTION__);
|
|
ret = -EFAULT;
|
|
goto kfree_read_buffer;
|
|
}
|
|
|
|
ret = read_buffer_size;
|
|
|
|
kfree_read_buffer:
|
|
kfree(read_buffer);
|
|
out:
|
|
LAN9252_UNLOCK;
|
|
|
|
return ret;
|
|
}
|
|
|
|
static ssize_t lan9252_write(struct file *file, const char *command_buff,
|
|
size_t command_buff_size, loff_t *f_pos)
|
|
{
|
|
u8 *command;
|
|
int ret = 0;
|
|
#ifdef DEBUG
|
|
int i;
|
|
#endif
|
|
|
|
LAN9252_LOCK;
|
|
|
|
if (command_buff_size <= 0) {
|
|
dev_err(&lan9252->dev, "command_buff_size(%d) <= 0 \n",
|
|
command_buff_size);
|
|
goto out;
|
|
} else {
|
|
dev_dbg(&lan9252->dev, "command_buff_size = %d\n",
|
|
command_buff_size);
|
|
}
|
|
|
|
command = (u8 *)kmalloc((command_buff_size) * sizeof(u8),
|
|
GFP_KERNEL | GFP_DMA);
|
|
if (!command) {
|
|
dev_err(&lan9252->dev, "write command kmalloc error\n");
|
|
ret = -ENOMEM;
|
|
goto out;
|
|
}
|
|
|
|
memset(command, 0, (command_buff_size) * sizeof(u8));
|
|
|
|
if (copy_from_user(command, command_buff, command_buff_size)) {
|
|
dev_err(&lan9252->dev, "%s() copy_from_user failed\n",
|
|
__FUNCTION__);
|
|
ret = -EFAULT;
|
|
goto kfree_command;
|
|
}
|
|
|
|
#ifdef DEBUG
|
|
for(i=0;i<command_buff_size;i++)
|
|
dev_dbg(&lan9252->dev, "command[%d]=0x%x\n",i,command[i]);
|
|
#endif
|
|
|
|
ret = spi_write_then_read(lan9252, command,
|
|
command_buff_size, NULL, 0);
|
|
if (ret < 0) {
|
|
dev_err(&lan9252->dev, "%s() spi_write_then_read failed "
|
|
"ret=%d\n", __FUNCTION__, ret);
|
|
goto kfree_command;
|
|
}
|
|
|
|
kfree_command:
|
|
kfree(command);
|
|
|
|
out:
|
|
LAN9252_UNLOCK;
|
|
|
|
return ret;
|
|
}
|
|
|
|
static long lan9252_ioctl(struct file *file, unsigned int cmd,
|
|
unsigned long argument)
|
|
{
|
|
int ret;
|
|
|
|
LAN9252_LOCK;
|
|
|
|
switch (cmd) {
|
|
case TEST:
|
|
ret = lan9252_test();
|
|
break;
|
|
|
|
default:
|
|
ret = 0;
|
|
break;
|
|
}
|
|
|
|
LAN9252_UNLOCK;
|
|
|
|
return ret;
|
|
}
|
|
|
|
|
|
static const struct spi_device_id lan9252_id_table[] = {
|
|
{ "lan9252", 0 },
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(spi, lan9252_id_table);
|
|
|
|
static const struct file_operations lan9252_fops = {
|
|
.owner = THIS_MODULE,
|
|
.llseek = lan9252_llseek,
|
|
.write = lan9252_write,
|
|
.read = lan9252_read,
|
|
.unlocked_ioctl = lan9252_ioctl,
|
|
};
|
|
|
|
static struct spi_driver lan9252_ethercat_driver = {
|
|
.driver = {
|
|
.name = DEVICE_NAME,
|
|
},
|
|
.id_table = lan9252_id_table,
|
|
.probe = lan9252_ethercat_probe,
|
|
.remove = lan9252_ethercat_remove,
|
|
};
|
|
|
|
struct miscdevice lan9252_miscdev = {
|
|
.minor = MISC_DYNAMIC_MINOR,
|
|
.name = DEVICE_NAME,
|
|
.fops = &lan9252_fops,
|
|
};
|
|
|
|
static int lan9252_ethercat_probe(struct spi_device *spi)
|
|
{
|
|
int ret;
|
|
|
|
mutex_init(&lock);
|
|
|
|
lan9252 = spi;
|
|
|
|
if(lan9252_test())
|
|
dev_warn(&spi->dev, "lan9252 not connected\n");
|
|
|
|
ret = misc_register(&lan9252_miscdev);
|
|
if (ret)
|
|
goto misc_register_fail;
|
|
|
|
dev_info(&spi->dev, "Probed\n");
|
|
|
|
return 0;
|
|
|
|
misc_register_fail:
|
|
dev_err(&spi->dev, "Probed failed : %d\n", ret);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int lan9252_ethercat_remove(struct spi_device *spi)
|
|
{
|
|
misc_deregister(&lan9252_miscdev);
|
|
|
|
dev_info(&spi->dev, "Removed\n");
|
|
|
|
return 0;
|
|
}
|
|
module_spi_driver(lan9252_ethercat_driver);
|
|
|
|
MODULE_AUTHOR("tykwon@m2i.co.kr");
|
|
MODULE_DESCRIPTION("Microchip LAN9252 Ethercat Driver");
|
|
MODULE_LICENSE("GPL");
|