2016-06-16 12:45:57 +03:00
/*
* Copyright ( c ) 2016 Masaki Ota < masaki . ota @ jp . alps . com >
*
* This program is free software ; you can redistribute it and / or modify it
* under the terms of the GNU General Public License as published by the Free
* Software Foundation ; either version 2 of the License , or ( at your option )
* any later version .
*/
# include <linux/kernel.h>
# include <linux/hid.h>
# include <linux/input.h>
# include <linux/input/mt.h>
# include <linux/module.h>
# include <asm/unaligned.h>
# include "hid-ids.h"
/* ALPS Device Product ID */
# define HID_PRODUCT_ID_T3_BTNLESS 0xD0C0
# define HID_PRODUCT_ID_COSMO 0x1202
# define HID_PRODUCT_ID_U1_PTP_1 0x1207
# define HID_PRODUCT_ID_U1 0x1209
# define HID_PRODUCT_ID_U1_PTP_2 0x120A
# define HID_PRODUCT_ID_U1_DUAL 0x120B
# define HID_PRODUCT_ID_T4_BTNLESS 0x120C
# define DEV_SINGLEPOINT 0x01
# define DEV_DUALPOINT 0x02
# define U1_MOUSE_REPORT_ID 0x01 /* Mouse data ReportID */
# define U1_ABSOLUTE_REPORT_ID 0x03 /* Absolute data ReportID */
# define U1_FEATURE_REPORT_ID 0x05 /* Feature ReportID */
# define U1_SP_ABSOLUTE_REPORT_ID 0x06 /* Feature ReportID */
# define U1_FEATURE_REPORT_LEN 0x08 /* Feature Report Length */
# define U1_FEATURE_REPORT_LEN_ALL 0x0A
# define U1_CMD_REGISTER_READ 0xD1
# define U1_CMD_REGISTER_WRITE 0xD2
# define U1_DEVTYPE_SP_SUPPORT 0x10 /* SP Support */
# define U1_DISABLE_DEV 0x01
# define U1_TP_ABS_MODE 0x02
# define U1_SP_ABS_MODE 0x80
# define ADDRESS_U1_DEV_CTRL_1 0x00800040
# define ADDRESS_U1_DEVICE_TYP 0x00800043
# define ADDRESS_U1_NUM_SENS_X 0x00800047
# define ADDRESS_U1_NUM_SENS_Y 0x00800048
# define ADDRESS_U1_PITCH_SENS_X 0x00800049
# define ADDRESS_U1_PITCH_SENS_Y 0x0080004A
# define ADDRESS_U1_RESO_DWN_ABS 0x0080004E
# define ADDRESS_U1_PAD_BTN 0x00800052
# define ADDRESS_U1_SP_BTN 0x0080009F
2017-10-06 05:53:17 +03:00
# define T4_INPUT_REPORT_LEN sizeof(struct t4_input_report)
# define T4_FEATURE_REPORT_LEN T4_INPUT_REPORT_LEN
# define T4_FEATURE_REPORT_ID 7
# define T4_CMD_REGISTER_READ 0x08
# define T4_CMD_REGISTER_WRITE 0x07
# define T4_ADDRESS_BASE 0xC2C0
# define PRM_SYS_CONFIG_1 (T4_ADDRESS_BASE + 0x0002)
# define T4_PRM_FEED_CONFIG_1 (T4_ADDRESS_BASE + 0x0004)
# define T4_PRM_FEED_CONFIG_4 (T4_ADDRESS_BASE + 0x001A)
# define T4_PRM_ID_CONFIG_3 (T4_ADDRESS_BASE + 0x00B0)
# define T4_FEEDCFG4_ADVANCED_ABS_ENABLE 0x01
# define T4_I2C_ABS 0x78
# define T4_COUNT_PER_ELECTRODE 256
2016-06-16 12:45:57 +03:00
# define MAX_TOUCHES 5
2017-10-06 05:53:17 +03:00
enum dev_num {
U1 ,
T4 ,
UNKNOWN ,
} ;
2016-06-16 12:45:57 +03:00
/**
* struct u1_data
*
* @ input : pointer to the kernel input device
* @ input2 : pointer to the kernel input2 device
* @ hdev : pointer to the struct hid_device
*
* @ dev_type : device type
2017-10-06 05:53:16 +03:00
* @ max_fingers : total number of fingers
* @ has_sp : boolean of sp existense
* @ sp_btn_info : button information
2016-06-16 12:45:57 +03:00
* @ x_active_len_mm : active area length of X ( mm )
* @ y_active_len_mm : active area length of Y ( mm )
* @ x_max : maximum x coordinate value
* @ y_max : maximum y coordinate value
2017-10-06 05:53:15 +03:00
* @ x_min : minimum x coordinate value
* @ y_min : minimum y coordinate value
2016-06-16 12:45:57 +03:00
* @ btn_cnt : number of buttons
* @ sp_btn_cnt : number of stick buttons
*/
2017-10-06 05:53:17 +03:00
struct alps_dev {
2016-06-16 12:45:57 +03:00
struct input_dev * input ;
struct input_dev * input2 ;
struct hid_device * hdev ;
2017-10-06 05:53:17 +03:00
enum dev_num dev_type ;
2017-10-06 05:53:16 +03:00
u8 max_fingers ;
u8 has_sp ;
2016-06-16 12:45:57 +03:00
u8 sp_btn_info ;
u32 x_active_len_mm ;
u32 y_active_len_mm ;
u32 x_max ;
u32 y_max ;
2017-10-06 05:53:15 +03:00
u32 x_min ;
u32 y_min ;
2016-06-16 12:45:57 +03:00
u32 btn_cnt ;
u32 sp_btn_cnt ;
} ;
2017-10-06 05:53:17 +03:00
struct t4_contact_data {
u8 palm ;
u8 x_lo ;
u8 x_hi ;
u8 y_lo ;
u8 y_hi ;
} ;
struct t4_input_report {
u8 reportID ;
u8 numContacts ;
struct t4_contact_data contact [ 5 ] ;
u8 button ;
u8 track [ 5 ] ;
u8 zx [ 5 ] , zy [ 5 ] ;
u8 palmTime [ 5 ] ;
u8 kilroy ;
u16 timeStamp ;
} ;
static u16 t4_calc_check_sum ( u8 * buffer ,
unsigned long offset , unsigned long length )
{
u16 sum1 = 0xFF , sum2 = 0xFF ;
unsigned long i = 0 ;
if ( offset + length > = 50 )
return 0 ;
while ( length > 0 ) {
u32 tlen = length > 20 ? 20 : length ;
length - = tlen ;
do {
sum1 + = buffer [ offset + i ] ;
sum2 + = sum1 ;
i + + ;
} while ( - - tlen > 0 ) ;
sum1 = ( sum1 & 0xFF ) + ( sum1 > > 8 ) ;
sum2 = ( sum2 & 0xFF ) + ( sum2 > > 8 ) ;
}
sum1 = ( sum1 & 0xFF ) + ( sum1 > > 8 ) ;
sum2 = ( sum2 & 0xFF ) + ( sum2 > > 8 ) ;
return ( sum2 < < 8 | sum1 ) ;
}
static int t4_read_write_register ( struct hid_device * hdev , u32 address ,
u8 * read_val , u8 write_val , bool read_flag )
{
int ret ;
u16 check_sum ;
u8 * input ;
2018-03-19 23:53:27 +03:00
u8 * readbuf = NULL ;
2017-10-06 05:53:17 +03:00
input = kzalloc ( T4_FEATURE_REPORT_LEN , GFP_KERNEL ) ;
if ( ! input )
return - ENOMEM ;
input [ 0 ] = T4_FEATURE_REPORT_ID ;
if ( read_flag ) {
input [ 1 ] = T4_CMD_REGISTER_READ ;
input [ 8 ] = 0x00 ;
} else {
input [ 1 ] = T4_CMD_REGISTER_WRITE ;
input [ 8 ] = write_val ;
}
put_unaligned_le32 ( address , input + 2 ) ;
input [ 6 ] = 1 ;
input [ 7 ] = 0 ;
/* Calculate the checksum */
check_sum = t4_calc_check_sum ( input , 1 , 8 ) ;
input [ 9 ] = ( u8 ) check_sum ;
input [ 10 ] = ( u8 ) ( check_sum > > 8 ) ;
input [ 11 ] = 0 ;
ret = hid_hw_raw_request ( hdev , T4_FEATURE_REPORT_ID , input ,
T4_FEATURE_REPORT_LEN ,
HID_FEATURE_REPORT , HID_REQ_SET_REPORT ) ;
if ( ret < 0 ) {
dev_err ( & hdev - > dev , " failed to read command (%d) \n " , ret ) ;
goto exit ;
}
if ( read_flag ) {
2018-03-19 23:53:27 +03:00
readbuf = kzalloc ( T4_FEATURE_REPORT_LEN , GFP_KERNEL ) ;
2017-10-06 05:53:17 +03:00
if ( ! readbuf ) {
ret = - ENOMEM ;
goto exit ;
}
ret = hid_hw_raw_request ( hdev , T4_FEATURE_REPORT_ID , readbuf ,
T4_FEATURE_REPORT_LEN ,
HID_FEATURE_REPORT , HID_REQ_GET_REPORT ) ;
if ( ret < 0 ) {
dev_err ( & hdev - > dev , " failed read register (%d) \n " , ret ) ;
goto exit_readbuf ;
}
2018-03-19 23:53:26 +03:00
ret = - EINVAL ;
2017-10-06 05:53:17 +03:00
if ( * ( u32 * ) & readbuf [ 6 ] ! = address ) {
dev_err ( & hdev - > dev , " read register address error (%x,%x) \n " ,
2018-03-19 23:53:29 +03:00
* ( u32 * ) & readbuf [ 6 ] , address ) ;
2017-10-06 05:53:17 +03:00
goto exit_readbuf ;
}
if ( * ( u16 * ) & readbuf [ 10 ] ! = 1 ) {
dev_err ( & hdev - > dev , " read register size error (%x) \n " ,
2018-03-19 23:53:29 +03:00
* ( u16 * ) & readbuf [ 10 ] ) ;
2017-10-06 05:53:17 +03:00
goto exit_readbuf ;
}
check_sum = t4_calc_check_sum ( readbuf , 6 , 7 ) ;
if ( * ( u16 * ) & readbuf [ 13 ] ! = check_sum ) {
dev_err ( & hdev - > dev , " read register checksum error (%x,%x) \n " ,
2018-03-19 23:53:29 +03:00
* ( u16 * ) & readbuf [ 13 ] , check_sum ) ;
2017-10-06 05:53:17 +03:00
goto exit_readbuf ;
}
* read_val = readbuf [ 12 ] ;
}
ret = 0 ;
exit_readbuf :
kfree ( readbuf ) ;
exit :
kfree ( input ) ;
return ret ;
}
2016-06-16 12:45:57 +03:00
static int u1_read_write_register ( struct hid_device * hdev , u32 address ,
u8 * read_val , u8 write_val , bool read_flag )
{
int ret , i ;
u8 check_sum ;
u8 * input ;
u8 * readbuf ;
2016-06-22 07:11:08 +03:00
input = kzalloc ( U1_FEATURE_REPORT_LEN , GFP_KERNEL ) ;
2016-06-16 12:45:57 +03:00
if ( ! input )
return - ENOMEM ;
input [ 0 ] = U1_FEATURE_REPORT_ID ;
if ( read_flag ) {
input [ 1 ] = U1_CMD_REGISTER_READ ;
input [ 6 ] = 0x00 ;
} else {
input [ 1 ] = U1_CMD_REGISTER_WRITE ;
input [ 6 ] = write_val ;
}
put_unaligned_le32 ( address , input + 2 ) ;
/* Calculate the checksum */
check_sum = U1_FEATURE_REPORT_LEN_ALL ;
for ( i = 0 ; i < U1_FEATURE_REPORT_LEN - 1 ; i + + )
check_sum + = input [ i ] ;
input [ 7 ] = check_sum ;
ret = hid_hw_raw_request ( hdev , U1_FEATURE_REPORT_ID , input ,
2016-06-22 07:11:08 +03:00
U1_FEATURE_REPORT_LEN ,
HID_FEATURE_REPORT , HID_REQ_SET_REPORT ) ;
2016-06-16 12:45:57 +03:00
if ( ret < 0 ) {
dev_err ( & hdev - > dev , " failed to read command (%d) \n " , ret ) ;
goto exit ;
}
if ( read_flag ) {
2016-06-22 07:11:08 +03:00
readbuf = kzalloc ( U1_FEATURE_REPORT_LEN , GFP_KERNEL ) ;
if ( ! readbuf ) {
2016-09-11 07:09:01 +03:00
ret = - ENOMEM ;
goto exit ;
2016-06-22 07:11:08 +03:00
}
2016-06-16 12:45:57 +03:00
ret = hid_hw_raw_request ( hdev , U1_FEATURE_REPORT_ID , readbuf ,
2016-06-22 07:11:08 +03:00
U1_FEATURE_REPORT_LEN ,
2016-06-20 12:16:18 +03:00
HID_FEATURE_REPORT , HID_REQ_GET_REPORT ) ;
2016-06-16 12:45:57 +03:00
if ( ret < 0 ) {
dev_err ( & hdev - > dev , " failed read register (%d) \n " , ret ) ;
2016-09-11 07:09:01 +03:00
kfree ( readbuf ) ;
2016-06-16 12:45:57 +03:00
goto exit ;
}
* read_val = readbuf [ 6 ] ;
2016-06-22 07:11:08 +03:00
kfree ( readbuf ) ;
2016-06-16 12:45:57 +03:00
}
2016-06-22 07:11:08 +03:00
ret = 0 ;
2016-06-16 12:45:57 +03:00
exit :
kfree ( input ) ;
return ret ;
}
2017-10-06 05:53:17 +03:00
static int t4_raw_event ( struct alps_dev * hdata , u8 * data , int size )
{
unsigned int x , y , z ;
int i ;
struct t4_input_report * p_report = ( struct t4_input_report * ) data ;
if ( ! data )
return 0 ;
for ( i = 0 ; i < hdata - > max_fingers ; i + + ) {
x = p_report - > contact [ i ] . x_hi < < 8 | p_report - > contact [ i ] . x_lo ;
y = p_report - > contact [ i ] . y_hi < < 8 | p_report - > contact [ i ] . y_lo ;
y = hdata - > y_max - y + hdata - > y_min ;
z = ( p_report - > contact [ i ] . palm < 0x80 & &
p_report - > contact [ i ] . palm > 0 ) * 62 ;
if ( x = = 0xffff ) {
x = 0 ;
y = 0 ;
z = 0 ;
}
input_mt_slot ( hdata - > input , i ) ;
input_mt_report_slot_state ( hdata - > input ,
MT_TOOL_FINGER , z ! = 0 ) ;
if ( ! z )
continue ;
input_report_abs ( hdata - > input , ABS_MT_POSITION_X , x ) ;
input_report_abs ( hdata - > input , ABS_MT_POSITION_Y , y ) ;
input_report_abs ( hdata - > input , ABS_MT_PRESSURE , z ) ;
}
input_mt_sync_frame ( hdata - > input ) ;
input_report_key ( hdata - > input , BTN_LEFT , p_report - > button ) ;
input_sync ( hdata - > input ) ;
return 1 ;
}
static int u1_raw_event ( struct alps_dev * hdata , u8 * data , int size )
2016-06-16 12:45:57 +03:00
{
2016-06-22 07:11:08 +03:00
unsigned int x , y , z ;
int i ;
short sp_x , sp_y ;
2016-06-16 12:45:57 +03:00
2017-10-06 05:53:17 +03:00
if ( ! data )
return 0 ;
2016-06-16 12:45:57 +03:00
switch ( data [ 0 ] ) {
case U1_MOUSE_REPORT_ID :
break ;
case U1_FEATURE_REPORT_ID :
break ;
case U1_ABSOLUTE_REPORT_ID :
2017-10-06 05:53:17 +03:00
for ( i = 0 ; i < hdata - > max_fingers ; i + + ) {
2016-06-22 07:11:08 +03:00
u8 * contact = & data [ i * 5 ] ;
x = get_unaligned_le16 ( contact + 3 ) ;
y = get_unaligned_le16 ( contact + 5 ) ;
z = contact [ 7 ] & 0x7F ;
2016-06-16 12:45:57 +03:00
input_mt_slot ( hdata - > input , i ) ;
2016-06-22 07:11:08 +03:00
if ( z ! = 0 ) {
2016-06-16 12:45:57 +03:00
input_mt_report_slot_state ( hdata - > input ,
MT_TOOL_FINGER , 1 ) ;
2016-09-27 08:04:37 +03:00
input_report_abs ( hdata - > input ,
ABS_MT_POSITION_X , x ) ;
input_report_abs ( hdata - > input ,
ABS_MT_POSITION_Y , y ) ;
input_report_abs ( hdata - > input ,
ABS_MT_PRESSURE , z ) ;
2016-06-16 12:45:57 +03:00
} else {
input_mt_report_slot_state ( hdata - > input ,
MT_TOOL_FINGER , 0 ) ;
}
}
input_mt_sync_frame ( hdata - > input ) ;
2016-06-22 07:11:08 +03:00
input_report_key ( hdata - > input , BTN_LEFT ,
data [ 1 ] & 0x1 ) ;
input_report_key ( hdata - > input , BTN_RIGHT ,
( data [ 1 ] & 0x2 ) ) ;
input_report_key ( hdata - > input , BTN_MIDDLE ,
( data [ 1 ] & 0x4 ) ) ;
input_sync ( hdata - > input ) ;
2016-06-16 12:45:57 +03:00
return 1 ;
case U1_SP_ABSOLUTE_REPORT_ID :
2016-06-22 07:11:08 +03:00
sp_x = get_unaligned_le16 ( data + 2 ) ;
sp_y = get_unaligned_le16 ( data + 4 ) ;
2016-06-16 12:45:57 +03:00
sp_x = sp_x / 8 ;
sp_y = sp_y / 8 ;
2016-06-22 07:11:08 +03:00
input_report_rel ( hdata - > input2 , REL_X , sp_x ) ;
input_report_rel ( hdata - > input2 , REL_Y , sp_y ) ;
2016-06-16 12:45:57 +03:00
2016-06-22 07:11:08 +03:00
input_report_key ( hdata - > input2 , BTN_LEFT ,
data [ 1 ] & 0x1 ) ;
input_report_key ( hdata - > input2 , BTN_RIGHT ,
( data [ 1 ] & 0x2 ) ) ;
input_report_key ( hdata - > input2 , BTN_MIDDLE ,
( data [ 1 ] & 0x4 ) ) ;
2016-06-16 12:45:57 +03:00
2016-06-22 07:11:08 +03:00
input_sync ( hdata - > input2 ) ;
2016-06-16 12:45:57 +03:00
return 1 ;
}
return 0 ;
}
2017-10-06 05:53:17 +03:00
static int alps_raw_event ( struct hid_device * hdev ,
struct hid_report * report , u8 * data , int size )
2016-06-16 12:45:57 +03:00
{
2017-10-06 05:53:17 +03:00
int ret = 0 ;
struct alps_dev * hdata = hid_get_drvdata ( hdev ) ;
switch ( hdev - > product ) {
case HID_PRODUCT_ID_T4_BTNLESS :
ret = t4_raw_event ( hdata , data , size ) ;
break ;
default :
ret = u1_raw_event ( hdata , data , size ) ;
break ;
}
return ret ;
2016-06-16 12:45:57 +03:00
}
2017-10-06 05:53:17 +03:00
static int __maybe_unused alps_post_reset ( struct hid_device * hdev )
2016-06-16 12:45:57 +03:00
{
2017-10-06 05:53:17 +03:00
int ret = - 1 ;
struct alps_dev * data = hid_get_drvdata ( hdev ) ;
switch ( data - > dev_type ) {
case T4 :
ret = t4_read_write_register ( hdev , T4_PRM_FEED_CONFIG_1 ,
NULL , T4_I2C_ABS , false ) ;
2018-03-19 23:53:28 +03:00
if ( ret < 0 ) {
dev_err ( & hdev - > dev , " failed T4_PRM_FEED_CONFIG_1 (%d) \n " ,
ret ) ;
goto exit ;
}
2017-10-06 05:53:17 +03:00
ret = t4_read_write_register ( hdev , T4_PRM_FEED_CONFIG_4 ,
NULL , T4_FEEDCFG4_ADVANCED_ABS_ENABLE , false ) ;
2018-03-19 23:53:28 +03:00
if ( ret < 0 ) {
dev_err ( & hdev - > dev , " failed T4_PRM_FEED_CONFIG_4 (%d) \n " ,
ret ) ;
goto exit ;
}
2017-10-06 05:53:17 +03:00
break ;
case U1 :
ret = u1_read_write_register ( hdev ,
ADDRESS_U1_DEV_CTRL_1 , NULL ,
U1_TP_ABS_MODE | U1_SP_ABS_MODE , false ) ;
2018-03-19 23:53:28 +03:00
if ( ret < 0 ) {
dev_err ( & hdev - > dev , " failed to change TP mode (%d) \n " ,
ret ) ;
goto exit ;
}
2017-10-06 05:53:17 +03:00
break ;
default :
break ;
}
2018-03-19 23:53:28 +03:00
exit :
2017-10-06 05:53:17 +03:00
return ret ;
}
static int __maybe_unused alps_post_resume ( struct hid_device * hdev )
{
return alps_post_reset ( hdev ) ;
2016-06-16 12:45:57 +03:00
}
2017-10-06 05:53:17 +03:00
static int u1_init ( struct hid_device * hdev , struct alps_dev * pri_data )
2016-06-16 12:45:57 +03:00
{
int ret ;
2017-10-06 05:53:16 +03:00
u8 tmp , dev_ctrl , sen_line_num_x , sen_line_num_y ;
u8 pitch_x , pitch_y , resolution ;
2016-06-16 12:45:57 +03:00
/* Device initialization */
ret = u1_read_write_register ( hdev , ADDRESS_U1_DEV_CTRL_1 ,
2017-10-06 05:53:16 +03:00
& dev_ctrl , 0 , true ) ;
2016-06-16 12:45:57 +03:00
if ( ret < 0 ) {
dev_err ( & hdev - > dev , " failed U1_DEV_CTRL_1 (%d) \n " , ret ) ;
goto exit ;
}
2017-10-06 05:53:16 +03:00
dev_ctrl & = ~ U1_DISABLE_DEV ;
dev_ctrl | = U1_TP_ABS_MODE ;
2016-06-16 12:45:57 +03:00
ret = u1_read_write_register ( hdev , ADDRESS_U1_DEV_CTRL_1 ,
2017-10-06 05:53:16 +03:00
NULL , dev_ctrl , false ) ;
2016-06-16 12:45:57 +03:00
if ( ret < 0 ) {
dev_err ( & hdev - > dev , " failed to change TP mode (%d) \n " , ret ) ;
goto exit ;
}
ret = u1_read_write_register ( hdev , ADDRESS_U1_NUM_SENS_X ,
2017-10-06 05:53:16 +03:00
& sen_line_num_x , 0 , true ) ;
2016-06-16 12:45:57 +03:00
if ( ret < 0 ) {
dev_err ( & hdev - > dev , " failed U1_NUM_SENS_X (%d) \n " , ret ) ;
goto exit ;
}
ret = u1_read_write_register ( hdev , ADDRESS_U1_NUM_SENS_Y ,
2017-10-06 05:53:16 +03:00
& sen_line_num_y , 0 , true ) ;
2016-06-16 12:45:57 +03:00
if ( ret < 0 ) {
dev_err ( & hdev - > dev , " failed U1_NUM_SENS_Y (%d) \n " , ret ) ;
goto exit ;
}
ret = u1_read_write_register ( hdev , ADDRESS_U1_PITCH_SENS_X ,
2017-10-06 05:53:16 +03:00
& pitch_x , 0 , true ) ;
2016-06-16 12:45:57 +03:00
if ( ret < 0 ) {
dev_err ( & hdev - > dev , " failed U1_PITCH_SENS_X (%d) \n " , ret ) ;
goto exit ;
}
ret = u1_read_write_register ( hdev , ADDRESS_U1_PITCH_SENS_Y ,
2017-10-06 05:53:16 +03:00
& pitch_y , 0 , true ) ;
2016-06-16 12:45:57 +03:00
if ( ret < 0 ) {
dev_err ( & hdev - > dev , " failed U1_PITCH_SENS_Y (%d) \n " , ret ) ;
goto exit ;
}
ret = u1_read_write_register ( hdev , ADDRESS_U1_RESO_DWN_ABS ,
2017-10-06 05:53:16 +03:00
& resolution , 0 , true ) ;
2016-06-16 12:45:57 +03:00
if ( ret < 0 ) {
dev_err ( & hdev - > dev , " failed U1_RESO_DWN_ABS (%d) \n " , ret ) ;
goto exit ;
}
2017-10-06 05:53:14 +03:00
pri_data - > x_active_len_mm =
2017-10-06 05:53:16 +03:00
( pitch_x * ( sen_line_num_x - 1 ) ) / 10 ;
2017-10-06 05:53:14 +03:00
pri_data - > y_active_len_mm =
2017-10-06 05:53:16 +03:00
( pitch_y * ( sen_line_num_y - 1 ) ) / 10 ;
2017-10-06 05:53:14 +03:00
pri_data - > x_max =
2017-10-06 05:53:16 +03:00
( resolution < < 2 ) * ( sen_line_num_x - 1 ) ;
2017-10-06 05:53:15 +03:00
pri_data - > x_min = 1 ;
2017-10-06 05:53:14 +03:00
pri_data - > y_max =
2017-10-06 05:53:16 +03:00
( resolution < < 2 ) * ( sen_line_num_y - 1 ) ;
2017-10-06 05:53:15 +03:00
pri_data - > y_min = 1 ;
2016-06-16 12:45:57 +03:00
ret = u1_read_write_register ( hdev , ADDRESS_U1_PAD_BTN ,
2017-10-06 05:53:16 +03:00
& tmp , 0 , true ) ;
2016-06-16 12:45:57 +03:00
if ( ret < 0 ) {
dev_err ( & hdev - > dev , " failed U1_PAD_BTN (%d) \n " , ret ) ;
goto exit ;
}
2017-10-06 05:53:16 +03:00
if ( ( tmp & 0x0F ) = = ( tmp & 0xF0 ) > > 4 ) {
pri_data - > btn_cnt = ( tmp & 0x0F ) ;
2017-10-06 05:53:15 +03:00
} else {
/* Button pad */
pri_data - > btn_cnt = 1 ;
}
2016-06-16 12:45:57 +03:00
2017-10-06 05:53:14 +03:00
pri_data - > has_sp = 0 ;
2016-06-16 12:45:57 +03:00
/* Check StickPointer device */
ret = u1_read_write_register ( hdev , ADDRESS_U1_DEVICE_TYP ,
2017-10-06 05:53:16 +03:00
& tmp , 0 , true ) ;
2016-06-16 12:45:57 +03:00
if ( ret < 0 ) {
dev_err ( & hdev - > dev , " failed U1_DEVICE_TYP (%d) \n " , ret ) ;
goto exit ;
}
2017-10-06 05:53:16 +03:00
if ( tmp & U1_DEVTYPE_SP_SUPPORT ) {
dev_ctrl | = U1_SP_ABS_MODE ;
2017-10-06 05:53:14 +03:00
ret = u1_read_write_register ( hdev , ADDRESS_U1_DEV_CTRL_1 ,
2017-10-06 05:53:16 +03:00
NULL , dev_ctrl , false ) ;
2017-10-06 05:53:14 +03:00
if ( ret < 0 ) {
dev_err ( & hdev - > dev , " failed SP mode (%d) \n " , ret ) ;
goto exit ;
}
ret = u1_read_write_register ( hdev , ADDRESS_U1_SP_BTN ,
& pri_data - > sp_btn_info , 0 , true ) ;
if ( ret < 0 ) {
dev_err ( & hdev - > dev , " failed U1_SP_BTN (%d) \n " , ret ) ;
goto exit ;
}
pri_data - > has_sp = 1 ;
}
2017-10-06 05:53:15 +03:00
pri_data - > max_fingers = 5 ;
2017-10-06 05:53:14 +03:00
exit :
return ret ;
}
2017-10-06 05:53:17 +03:00
static int T4_init ( struct hid_device * hdev , struct alps_dev * pri_data )
{
int ret ;
u8 tmp , sen_line_num_x , sen_line_num_y ;
ret = t4_read_write_register ( hdev , T4_PRM_ID_CONFIG_3 , & tmp , 0 , true ) ;
if ( ret < 0 ) {
dev_err ( & hdev - > dev , " failed T4_PRM_ID_CONFIG_3 (%d) \n " , ret ) ;
goto exit ;
}
sen_line_num_x = 16 + ( ( tmp & 0x0F ) | ( tmp & 0x08 ? 0xF0 : 0 ) ) ;
sen_line_num_y = 12 + ( ( ( tmp & 0xF0 ) > > 4 ) | ( tmp & 0x80 ? 0xF0 : 0 ) ) ;
pri_data - > x_max = sen_line_num_x * T4_COUNT_PER_ELECTRODE ;
pri_data - > x_min = T4_COUNT_PER_ELECTRODE ;
pri_data - > y_max = sen_line_num_y * T4_COUNT_PER_ELECTRODE ;
pri_data - > y_min = T4_COUNT_PER_ELECTRODE ;
pri_data - > x_active_len_mm = pri_data - > y_active_len_mm = 0 ;
pri_data - > btn_cnt = 1 ;
ret = t4_read_write_register ( hdev , PRM_SYS_CONFIG_1 , & tmp , 0 , true ) ;
if ( ret < 0 ) {
dev_err ( & hdev - > dev , " failed PRM_SYS_CONFIG_1 (%d) \n " , ret ) ;
goto exit ;
}
tmp | = 0x02 ;
ret = t4_read_write_register ( hdev , PRM_SYS_CONFIG_1 , NULL , tmp , false ) ;
if ( ret < 0 ) {
dev_err ( & hdev - > dev , " failed PRM_SYS_CONFIG_1 (%d) \n " , ret ) ;
goto exit ;
}
ret = t4_read_write_register ( hdev , T4_PRM_FEED_CONFIG_1 ,
NULL , T4_I2C_ABS , false ) ;
if ( ret < 0 ) {
dev_err ( & hdev - > dev , " failed T4_PRM_FEED_CONFIG_1 (%d) \n " , ret ) ;
goto exit ;
}
ret = t4_read_write_register ( hdev , T4_PRM_FEED_CONFIG_4 , NULL ,
T4_FEEDCFG4_ADVANCED_ABS_ENABLE , false ) ;
if ( ret < 0 ) {
dev_err ( & hdev - > dev , " failed T4_PRM_FEED_CONFIG_4 (%d) \n " , ret ) ;
goto exit ;
}
pri_data - > max_fingers = 5 ;
pri_data - > has_sp = 0 ;
exit :
return ret ;
}
2017-10-06 05:53:14 +03:00
static int alps_input_configured ( struct hid_device * hdev , struct hid_input * hi )
{
2017-10-06 05:53:17 +03:00
struct alps_dev * data = hid_get_drvdata ( hdev ) ;
2017-10-06 05:53:14 +03:00
struct input_dev * input = hi - > input , * input2 ;
int ret ;
int res_x , res_y , i ;
data - > input = input ;
hid_dbg ( hdev , " Opening low level driver \n " ) ;
ret = hid_hw_open ( hdev ) ;
if ( ret )
return ret ;
/* Allow incoming hid reports */
hid_device_io_start ( hdev ) ;
2017-10-06 05:53:17 +03:00
switch ( data - > dev_type ) {
case T4 :
ret = T4_init ( hdev , data ) ;
break ;
case U1 :
ret = u1_init ( hdev , data ) ;
break ;
default :
break ;
}
2017-10-06 05:53:14 +03:00
if ( ret )
goto exit ;
2016-06-16 12:45:57 +03:00
__set_bit ( EV_ABS , input - > evbit ) ;
2017-10-06 05:53:15 +03:00
input_set_abs_params ( input , ABS_MT_POSITION_X ,
data - > x_min , data - > x_max , 0 , 0 ) ;
input_set_abs_params ( input , ABS_MT_POSITION_Y ,
data - > y_min , data - > y_max , 0 , 0 ) ;
2016-06-16 12:45:57 +03:00
2017-10-06 05:53:13 +03:00
if ( data - > x_active_len_mm & & data - > y_active_len_mm ) {
res_x = ( data - > x_max - 1 ) / data - > x_active_len_mm ;
res_y = ( data - > y_max - 1 ) / data - > y_active_len_mm ;
2016-06-16 12:45:57 +03:00
input_abs_set_res ( input , ABS_MT_POSITION_X , res_x ) ;
input_abs_set_res ( input , ABS_MT_POSITION_Y , res_y ) ;
}
input_set_abs_params ( input , ABS_MT_PRESSURE , 0 , 64 , 0 , 0 ) ;
2017-10-06 05:53:15 +03:00
input_mt_init_slots ( input , data - > max_fingers , INPUT_MT_POINTER ) ;
2016-06-16 12:45:57 +03:00
__set_bit ( EV_KEY , input - > evbit ) ;
2017-10-06 05:53:15 +03:00
if ( data - > btn_cnt = = 1 )
2016-06-16 12:45:57 +03:00
__set_bit ( INPUT_PROP_BUTTONPAD , input - > propbit ) ;
2017-10-06 05:53:13 +03:00
for ( i = 0 ; i < data - > btn_cnt ; i + + )
2016-06-16 12:45:57 +03:00
__set_bit ( BTN_LEFT + i , input - > keybit ) ;
/* Stick device initialization */
2017-10-06 05:53:14 +03:00
if ( data - > has_sp ) {
2016-06-16 12:45:57 +03:00
input2 = input_allocate_device ( ) ;
if ( ! input2 ) {
2017-10-06 05:53:15 +03:00
input_free_device ( input2 ) ;
2016-06-16 12:45:57 +03:00
goto exit ;
}
2016-06-22 07:11:08 +03:00
data - > input2 = input2 ;
2016-06-16 12:45:57 +03:00
input2 - > phys = input - > phys ;
input2 - > name = " DualPoint Stick " ;
input2 - > id . bustype = BUS_I2C ;
input2 - > id . vendor = input - > id . vendor ;
input2 - > id . product = input - > id . product ;
input2 - > id . version = input - > id . version ;
input2 - > dev . parent = input - > dev . parent ;
__set_bit ( EV_KEY , input2 - > evbit ) ;
2017-10-06 05:53:13 +03:00
data - > sp_btn_cnt = ( data - > sp_btn_info & 0x0F ) ;
for ( i = 0 ; i < data - > sp_btn_cnt ; i + + )
2016-06-16 12:45:57 +03:00
__set_bit ( BTN_LEFT + i , input2 - > keybit ) ;
__set_bit ( EV_REL , input2 - > evbit ) ;
__set_bit ( REL_X , input2 - > relbit ) ;
__set_bit ( REL_Y , input2 - > relbit ) ;
__set_bit ( INPUT_PROP_POINTER , input2 - > propbit ) ;
__set_bit ( INPUT_PROP_POINTING_STICK , input2 - > propbit ) ;
2017-10-06 05:53:15 +03:00
if ( input_register_device ( data - > input2 ) ) {
2016-06-16 12:45:57 +03:00
input_free_device ( input2 ) ;
goto exit ;
}
}
exit :
hid_device_io_stop ( hdev ) ;
hid_hw_close ( hdev ) ;
return ret ;
}
static int alps_input_mapping ( struct hid_device * hdev ,
struct hid_input * hi , struct hid_field * field ,
struct hid_usage * usage , unsigned long * * bit , int * max )
{
return - 1 ;
}
static int alps_probe ( struct hid_device * hdev , const struct hid_device_id * id )
{
2017-10-06 05:53:17 +03:00
struct alps_dev * data = NULL ;
2016-06-16 12:45:57 +03:00
int ret ;
2017-10-06 05:53:17 +03:00
data = devm_kzalloc ( & hdev - > dev , sizeof ( struct alps_dev ) , GFP_KERNEL ) ;
2016-06-16 12:45:57 +03:00
if ( ! data )
return - ENOMEM ;
data - > hdev = hdev ;
hid_set_drvdata ( hdev , data ) ;
hdev - > quirks | = HID_QUIRK_NO_INIT_REPORTS ;
ret = hid_parse ( hdev ) ;
if ( ret ) {
hid_err ( hdev , " parse failed \n " ) ;
return ret ;
}
2017-10-06 05:53:17 +03:00
switch ( hdev - > product ) {
case HID_DEVICE_ID_ALPS_T4_BTNLESS :
data - > dev_type = T4 ;
break ;
case HID_DEVICE_ID_ALPS_U1_DUAL :
2017-10-06 05:53:18 +03:00
case HID_DEVICE_ID_ALPS_U1 :
2017-10-06 05:53:17 +03:00
data - > dev_type = U1 ;
break ;
default :
data - > dev_type = UNKNOWN ;
}
2016-06-16 12:45:57 +03:00
ret = hid_hw_start ( hdev , HID_CONNECT_DEFAULT ) ;
if ( ret ) {
hid_err ( hdev , " hw start failed \n " ) ;
return ret ;
}
return 0 ;
}
static void alps_remove ( struct hid_device * hdev )
{
hid_hw_stop ( hdev ) ;
}
static const struct hid_device_id alps_id [ ] = {
{ HID_DEVICE ( HID_BUS_ANY , HID_GROUP_ANY ,
2016-06-22 07:11:08 +03:00
USB_VENDOR_ID_ALPS_JP , HID_DEVICE_ID_ALPS_U1_DUAL ) } ,
2017-10-06 05:53:18 +03:00
{ HID_DEVICE ( HID_BUS_ANY , HID_GROUP_ANY ,
USB_VENDOR_ID_ALPS_JP , HID_DEVICE_ID_ALPS_U1 ) } ,
2017-10-06 05:53:17 +03:00
{ HID_DEVICE ( HID_BUS_ANY , HID_GROUP_ANY ,
USB_VENDOR_ID_ALPS_JP , HID_DEVICE_ID_ALPS_T4_BTNLESS ) } ,
2016-06-16 12:45:57 +03:00
{ }
} ;
MODULE_DEVICE_TABLE ( hid , alps_id ) ;
static struct hid_driver alps_driver = {
. name = " hid-alps " ,
. id_table = alps_id ,
. probe = alps_probe ,
. remove = alps_remove ,
. raw_event = alps_raw_event ,
. input_mapping = alps_input_mapping ,
. input_configured = alps_input_configured ,
# ifdef CONFIG_PM
. resume = alps_post_resume ,
. reset_resume = alps_post_reset ,
# endif
} ;
module_hid_driver ( alps_driver ) ;
MODULE_AUTHOR ( " Masaki Ota <masaki.ota@jp.alps.com> " ) ;
MODULE_DESCRIPTION ( " ALPS HID driver " ) ;
MODULE_LICENSE ( " GPL " ) ;