From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1753663AbbAPLUG (ORCPT ); Fri, 16 Jan 2015 06:20:06 -0500 Received: from m01.upixeltek.com ([203.67.208.22]:52152 "EHLO sism01.sis.com" rhost-flags-OK-FAIL-OK-OK) by vger.kernel.org with ESMTP id S1751363AbbAPLUE (ORCPT ); Fri, 16 Jan 2015 06:20:04 -0500 X-MimeOLE: Produced By Microsoft Exchange V6.5 Content-class: urn:content-classes:message MIME-Version: 1.0 Content-Type: text/plain; charset="utf-8" Subject: RE: [PATCH 1/2] INPUT/HID: add touch support for SiS touch driver Date: Fri, 16 Jan 2015 19:19:49 +0800 Message-ID: <8322374EB97AA24A95D0DDBFC8F1CA1DBF9E1F@SISMBEV01.sis.com.tw> X-MS-Has-Attach: X-MS-TNEF-Correlator: Thread-Topic: [PATCH 1/2] INPUT/HID: add touch support for SiS touch driver Thread-Index: AdAxX1WC8D+hkTRzRS+b9ecI0wRMLgAABKZgAAR2pxAAAy1ukA== References: <8322374EB97AA24A95D0DDBFC8F1CA1DBF987B@SISMBEV01.sis.com.tw><1421063449.12454.17.camel@linux-0dmf.site> <8322374EB97AA24A95D0DDBFC8F1CA1DBF9DE5@SISMBEV01.sis.com.tw> From: =?utf-8?B?5pu+5am36JGzICh0YW1teV90c2VuZyk=?= To: "Oliver Neukum" , , Cc: X-OriginalArrivalTime: 16 Jan 2015 11:19:50.0414 (UTC) FILETIME=[57E6FAE0:01D0317E] X-TM-AS-Product-Ver: SMEX-10.2.0.3176-7.500.1018-21256.004 X-TM-AS-Result: No--24.390400-0.000000-31 X-TM-AS-User-Approved-Sender: Yes X-TM-AS-User-Blocked-Sender: No X-Received-IP: 192.168.50.87 X-Envelope-From: X-Sherlock-Send: MailFilter (sism01.sis.com) X-License: 1 Sender: linux-kernel-owner@vger.kernel.org List-ID: X-Mailing-List: linux-kernel@vger.kernel.org Content-Transfer-Encoding: 8bit X-MIME-Autoconverted: from base64 to 8bit by nfs id t0GBKGlw022021 Hey, Oliver On Mon, Jan 12, 2015 at 7:50 PM, Oliver Neukum wrote: On Mon, 2015-01-12 at 18:53 +0800, 曾婷葳 (tammy_tseng) wrote: > > (Skip the code diff...) > > Again macros for endianness > > And the driver has a great number of conditional compilations are they > really needed? The driver as is has a number of issues and is hard to > review due to the use of "//" for comments and a lot of conditional > compilation and unnecessary variables used for constants. Could you > fix this up and resubmit? Thanks for the reply. I've modified the code (sis_i2c.c/sis_i2c.h/Kconfig/Makefile) to fix them. Please help check them if anything needs to fix. Thanks. Tammy --- diff --git a/linux-3.18.1/drivers/input/touchscreen/Kconfig b/linux-3.18.1/drivers/input/touchscreen/Kconfig index e1d8003..401cd8b 100644 --- a/linux-3.18.1/drivers/input/touchscreen/Kconfig +++ b/linux-3.18.1/drivers/input/touchscreen/Kconfig @@ -962,4 +962,12 @@ config TOUCHSCREEN_ZFORCE To compile this driver as a module, choose M here: the module will be called zforce_ts. +config TOUCHSCREEN_SIS_I2C + tristate "SiS 9200 family I2C touchscreen driver" + depends on I2C + default n + help + This enables support for SiS 9200 family over I2C based touchscreens. + + endif diff --git a/linux-3.18.1/drivers/input/touchscreen/Makefile b/linux-3.18.1/drivers/input/touchscreen/Makefile index 090e61c..67137af 100644 --- a/linux-3.18.1/drivers/input/touchscreen/Makefile +++ b/linux-3.18.1/drivers/input/touchscreen/Makefile @@ -79,3 +79,4 @@ obj-$(CONFIG_TOUCHSCREEN_WM97XX_ZYLONITE) += zylonite-wm97xx.o obj-$(CONFIG_TOUCHSCREEN_W90X900) += w90p910_ts.o obj-$(CONFIG_TOUCHSCREEN_TPS6507X) += tps6507x-ts.o obj-$(CONFIG_TOUCHSCREEN_ZFORCE) += zforce_ts.o +obj-$(CONFIG_TOUCHSCREEN_SIS_I2C) += sis_i2c.o diff --git a/linux-3.18.1/drivers/input/touchscreen/sis_i2c.c b/linux-3.18.1/drivers/input/touchscreen/sis_i2c.c new file mode 100644 index 0000000..157f991 --- /dev/null +++ b/linux-3.18.1/drivers/input/touchscreen/sis_i2c.c @@ -0,0 +1,1267 @@ +/* + * SiS 9200 family I2C Touch Screen Controller Driver + * + * Copyright (C) 2011 SiS, Inc. + * + * This software is licensed under the terms of the GNU General Public + * License version 2, as published by the Free Software Foundation, and + * may be copied, distributed, and modified under those terms. + * + * 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 +#include +#ifdef CONFIG_HAS_EARLYSUSPEND +#include +#endif +#include +#include +#include +#include +#include +#include +#include "sis_i2c.h" +#include +#include +#include +#include +#include +#include + +#ifdef _STD_RW_IO +#include +#include +#include +#define DEVICE_NAME "sis_aegis_touch_device" +static int sis_char_devs_count = 1; /* device count */ +static int sis_char_major = 0; +static struct cdev sis_char_cdev; +static struct class *sis_char_class = NULL; #endif + +/* Addresses to scan */ +static const unsigned short normal_i2c[] = { SIS_SLAVE_ADDR, +I2C_CLIENT_END }; static struct workqueue_struct *sis_wq; struct +sis_ts_data *ts_bak = 0; struct sisTP_driver_data *TPInfo = NULL; +static void sis_tpinfo_clear(struct sisTP_driver_data *TPInfo, int +max); + +#ifdef CONFIG_HAS_EARLYSUSPEND +static void sis_ts_early_suspend(struct early_suspend *h); static void +sis_ts_late_resume(struct early_suspend *h); #endif + +#ifdef CONFIG_X86 +/* static const struct i2c_client_address_data addr_data; */ +/* Insmod parameters */ +static int sis_ts_detect(struct i2c_client *client, struct +i2c_board_info *info); #endif + +#ifdef _CHECK_CRC +uint16_t cal_crc (char* cmd, int start, int end); #endif + +static void PrintBuffer(int start, int length, char* buf) { + int i; + for ( i = start; i < length; i++ ) + { + printk("%02x ", buf[i]); + if (i != 0 && i % 30 == 0) + printk("\n"); + } + printk("\n"); +} + +int sis_command_for_write(struct i2c_client *client, int wlength, +unsigned char *wdata) { + int ret = -1; + struct i2c_msg msg; + + msg.addr = client->addr; + /* Write */ + msg.flags = 0; + msg.len = wlength; + msg.buf = (unsigned char *)wdata; + + ret = i2c_transfer(client->adapter, &msg, 1); + + return ret; +} + +int sis_command_for_read(struct i2c_client *client, int rlength, +unsigned char *rdata) { + int ret = -1; + struct i2c_msg msg; + + msg.addr = client->addr; + /* Read */ + msg.flags = I2C_M_RD; + msg.len = rlength; + msg.buf = rdata; + + ret = i2c_transfer(client->adapter, &msg, 1); + + return ret; +} + +int sis_cul_unit(uint8_t report_id) +{ + int ret = NORMAL_LEN_PER_POINT; + + if (report_id != ALL_IN_ONE_PACKAGE) + { + if (IS_AREA(report_id) /*&& IS_TOUCH(report_id)*/) + { + ret += AREA_LEN_PER_POINT; + } + if (IS_PRESSURE(report_id)) + { + ret += PRESSURE_LEN_PER_POINT; + } + } + + return ret; +} + +int sis_ReadPacket(struct i2c_client *client, uint8_t cmd, uint8_t* +buf) { + uint8_t tmpbuf[MAX_BYTE] = {0}; +#ifdef _CHECK_CRC + uint16_t buf_crc = 0; + uint16_t package_crc = 0; + int l_package_crc = 0; + int crc_end = 0; +#endif + int ret = -1; + int touchnum = 0; + int p_count = 0; + int touc_formate_id = 0; + int locate = 0; + bool read_first = true; + +/* + New i2c format + * buf[0] = Low 8 bits of byte count value + * buf[1] = High 8 bits of byte counte value + * buf[2] = Report ID + * buf[touch num * 6 + 2 ] = Touch informations; 1 touch point has 6 bytes, it could be none if no touch + * buf[touch num * 6 + 3] = Touch numbers + * + * One touch point information include 6 bytes, the order is + * + * 1. status = touch down or touch up + * 2. id = finger id + * 3. x axis low 8 bits + * 4. x axis high 8 bits + * 5. y axis low 8 bits + * 6. y axis high 8 bits + * +*/ + do + { + if (locate >= PACKET_BUFFER_SIZE) + { + printk(KERN_ERR "sis_ReadPacket: Buf Overflow\n"); + return -1; + } + + ret = sis_command_for_read(client, MAX_BYTE, tmpbuf); + +#ifdef _DEBUG_PACKAGE + printk(KERN_INFO "chaoban test: Buf_Data [0~63] \n"); + PrintBuffer(0, 64, tmpbuf); +#endif + + if(ret < 0 ) + { + printk(KERN_ERR "sis_ReadPacket: i2c transfer error\n"); + return ret; + } + /* error package length of receiving data */ + else if (tmpbuf[P_BYTECOUNT] > MAX_BYTE) + { + printk(KERN_ERR "sis_ReadPacket: Error Bytecount\n"); + return -1; + } + + if (read_first) + { +#ifdef _SUPPORT_BUTTON_TOUCH + /* access BUTTON TOUCH event and BUTTON NO TOUCH event */ + if (tmpbuf[P_REPORT_ID] == BUTTON_FORMAT) + { + memcpy(&buf[0], &tmpbuf[0], 7); + return 0; /* touchnum is 0 */ + } +#endif + /* access NO TOUCH event unless BUTTON NO TOUCH event */ + if (tmpbuf[P_BYTECOUNT] == 0/*NO_TOUCH_BYTECOUNT*/) + { + return 0; /* touchnum is 0 */ + } + } + + /* skip parsing data when two devices are registered at the same slave address + * parsing data when P_REPORT_ID && 0xf is TOUCH_FORMAT or P_REPORT_ID is ALL_IN_ONE_PACKAGE + */ + touc_formate_id = tmpbuf[P_REPORT_ID] & 0xf; + if ((touc_formate_id != TOUCH_FORMAT) && (touc_formate_id != HIDI2C_FORMAT) && (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE)) + { + printk(KERN_ERR "sis_ReadPacket: Error Report_ID\n"); + return -1; + } + + p_count = (int) tmpbuf[P_BYTECOUNT] - 1; /* start from 0 */ + if (tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE) + { + if (IS_TOUCH(tmpbuf[P_REPORT_ID])) + { + p_count -= BYTE_CRC_I2C; /* delete 2 byte crc */ + } + else if (IS_HIDI2C(tmpbuf[P_REPORT_ID])) + { + p_count -= BYTE_CRC_HIDI2C; + } + else /* should not be happen */ + { + printk(KERN_ERR "sis_ReadPacket: delete crc error\n"); + return -1; + } + + if (IS_SCANTIME(tmpbuf[P_REPORT_ID])) + { + p_count -= BYTE_SCANTIME; + } + } + /* else {} For ALL_IN_ONE_PACKAGE */ + + if (read_first) + { + touchnum = tmpbuf[p_count]; + } + else + { + if (tmpbuf[p_count] != 0) + { + printk(KERN_ERR "sis_ReadPacket: get error package\n"); + return -1; + } + } + +#ifdef _CHECK_CRC + crc_end = p_count + (IS_SCANTIME(tmpbuf[P_REPORT_ID]) * 2); + buf_crc = cal_crc(tmpbuf, 2, crc_end); /* sub bytecount (2 byte) */ + l_package_crc = p_count + 1 + (IS_SCANTIME(tmpbuf[P_REPORT_ID]) * 2); + package_crc = get_unaligned_le16(&tmpbuf[l_package_crc]); + + if (buf_crc != package_crc) + { + printk(KERN_ERR "sis_ReadPacket: CRC Error\n"); + return -1; + } +#endif + memcpy(&buf[locate], &tmpbuf[0], 64); /* Buf_Data [0~63] [64~128] */ + locate += 64; + read_first = false; + + }while(tmpbuf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE && tmpbuf[p_count] +> 5); + + return touchnum; +} + + +int check_gpio_interrupt(void) +{ + int ret = 0; + + /* CHECK GPIO INTERRUPT STATUS BY YOUR PLATFORM SETTING. */ + ret = gpio_get_value(GPIO_IRQ); + + return ret; +} + +void ts_report_key(struct i2c_client *client, uint8_t keybit_state) { + int i = 0; + uint8_t diff_keybit_state= 0x0; /* check keybit_state is difference with pre_keybit_state */ + uint8_t key_value = 0x0; /* button location for binary */ + uint8_t key_pressed = 0x0; /* button is up or down */ + struct sis_ts_data *ts = i2c_get_clientdata(client); + + if (!ts) + { + printk(KERN_ERR "%s error: Missing Platform Data!\n", __func__); + return; + } + + diff_keybit_state = TPInfo->pre_keybit_state ^ keybit_state; + + if (diff_keybit_state) + { + for (i = 0; i < BUTTON_KEY_COUNT; i++) + { + if ((diff_keybit_state >> i) & 0x01) + { + key_value = diff_keybit_state & (0x01 << i); + key_pressed = (keybit_state >> i) & 0x01; + switch (key_value) + { + case MSK_COMP: + input_report_key(ts->input_dev, KEY_COMPOSE, key_pressed); + break; + case MSK_BACK: + input_report_key(ts->input_dev, KEY_BACK, key_pressed); + break; + case MSK_MENU: + input_report_key(ts->input_dev, KEY_MENU, key_pressed); + break; + case MSK_HOME: + input_report_key(ts->input_dev, KEY_HOME, key_pressed); + break; + case MSK_NOBTN: + /* Release the button if it touched. */ + default: + break; + } + } + } + TPInfo->pre_keybit_state = keybit_state; + } +} + + +static void sis_ts_work_func(struct work_struct *work) { + struct sis_ts_data *ts = container_of(work, struct sis_ts_data, work); + int ret = -1; + int point_unit; + uint8_t buf[PACKET_BUFFER_SIZE] = {0}; + uint8_t i = 0, fingers = 0; + uint8_t px = 0, py = 0, pstatus = 0; + uint8_t p_area = 0; + uint8_t p_preasure = 0; +#ifdef _SUPPORT_BUTTON_TOUCH + int button_key; + uint8_t button_buf[10] = {0}; +#endif + +#ifdef _ANDROID_4 + bool all_touch_up = true; +#endif + + mutex_lock(&ts->mutex_wq); + + /* I2C or SMBUS block data read */ + ret = sis_ReadPacket(ts->client, SIS_CMD_NORMAL, buf); + +#ifdef _SUPPORT_BUTTON_TOUCH + sis_ReadPacket(ts->client, SIS_CMD_NORMAL, button_buf); #endif + + /* Error Number */ + if (ret < 0) + { + goto err_free_allocate; + } +#ifdef _SUPPORT_BUTTON_TOUCH + /* access BUTTON TOUCH event and BUTTON NO TOUCH even */ + else if (button_buf[P_REPORT_ID] == BUTTON_FORMAT) + { + button_key = get_unaligned_le16(&button_buf[BUTTON_STATE]); + ts_report_key(ts->client, button_key); + } +#endif + /* access NO TOUCH event unless BUTTON NO TOUCH event */ + else if (ret == 0) + { + fingers = 0; + sis_tpinfo_clear(TPInfo, MAX_FINGERS); + goto label_send_report; /* need to report input_mt_sync() */ + } + + sis_tpinfo_clear(TPInfo, MAX_FINGERS); + + /* Parser and Get the sis9200 data */ + point_unit = sis_cul_unit(buf[P_REPORT_ID]); + fingers = ret; + + TPInfo->fingers = fingers = (fingers > MAX_FINGERS ? 0 : fingers); + + /* fingers 10 = 0 ~ 9 */ + for (i = 0; i < fingers; i++) + { + if ((buf[P_REPORT_ID] != ALL_IN_ONE_PACKAGE) && (i >= 5)) + { /* Calc point status */ + pstatus = BYTE_BYTECOUNT + BYTE_ReportID + ((i - 5) * point_unit); + pstatus += 64; + } + else + { /* Calc point status */ + pstatus = BYTE_BYTECOUNT + BYTE_ReportID + (i * point_unit); + } + + px = pstatus + 2; /* Calc point x_coord */ + py = px + 2; /* Calc point y_coord */ + + if ((buf[pstatus]) == TOUCHUP) + { + TPInfo->pt[i].Width = 0; + TPInfo->pt[i].Height = 0; + TPInfo->pt[i].Pressure = 0; + } + else if (buf[P_REPORT_ID] == ALL_IN_ONE_PACKAGE && (buf[pstatus]) == TOUCHDOWN) + { + TPInfo->pt[i].Width = 1; + TPInfo->pt[i].Height = 1; + TPInfo->pt[i].Pressure = 1; + } + else if ((buf[pstatus]) == TOUCHDOWN) + { + p_area = py + 2; + p_preasure = py + 2 + (IS_AREA(buf[P_REPORT_ID]) * 2); + + /* area */ + if (IS_AREA(buf[P_REPORT_ID])) + { + TPInfo->pt[i].Width = buf[p_area] & 0xff; + TPInfo->pt[i].Height = buf[p_area + 1] & 0xff; + } + else + { + TPInfo->pt[i].Width = 1; + TPInfo->pt[i].Height = 1; + } + /* preasure */ + if (IS_PRESSURE(buf[P_REPORT_ID])) + TPInfo->pt[i].Pressure = (buf[p_preasure]); + else + TPInfo->pt[i].Pressure = 1; + } + else + { + printk(KERN_ERR "sis_ts_work_func: Error Touch Status\n"); + goto err_free_allocate; + } + + TPInfo->pt[i].id = (buf[pstatus + 1]); + TPInfo->pt[i].x = ((buf[px] & 0xff) | ((buf[px + 1] & 0xff)<< 8)); + TPInfo->pt[i].y = ((buf[py] & 0xff) | ((buf[py + 1] & 0xff)<< 8)); + } + +#ifdef _DEBUG_REPORT + for (i = 0; i < TPInfo->fingers; i++) + { + printk(KERN_INFO "chaoban test: i = %d, id = %d, x = %d, y = %d, pstatus = %d, width = %d, height = %d, pressure = %d, \n", i, TPInfo->pt[i].id, TPInfo->pt[i].x, TPInfo->pt[i].y, buf[pstatus], TPInfo->pt[i].Width, TPInfo->pt[i].Height, TPInfo->pt[i].Pressure); + } +#endif + +label_send_report: +/* Report co-ordinates to the multi-touch stack */ +#ifdef _ANDROID_4 + for(i = 0; ((i < TPInfo->fingers) && (i < MAX_FINGERS)); i++) + { + if(TPInfo->pt[i].Pressure) + { + TPInfo->pt[i].Width *= AREA_UNIT; + input_report_abs(ts->input_dev, ABS_MT_TOUCH_MAJOR, TPInfo->pt[i].Width); + TPInfo->pt[i].Height *= AREA_UNIT; + input_report_abs(ts->input_dev, ABS_MT_TOUCH_MINOR, TPInfo->pt[i].Height); + input_report_abs(ts->input_dev, ABS_MT_PRESSURE, TPInfo->pt[i].Pressure); + input_report_abs(ts->input_dev, ABS_MT_POSITION_X, TPInfo->pt[i].x); + input_report_abs(ts->input_dev, ABS_MT_POSITION_Y, TPInfo->pt[i].y); + input_report_abs(ts->input_dev, ABS_MT_TRACKING_ID, TPInfo->pt[i].id); + input_mt_sync(ts->input_dev); + all_touch_up = false; + } + + if (i == (TPInfo->fingers -1) && all_touch_up == true) + { + input_mt_sync(ts->input_dev); + } + } + + if(TPInfo->fingers == 0) + { + input_mt_sync(ts->input_dev); + } +#else + i = 0; + do + { + input_report_abs(ts->input_dev, ABS_MT_TOUCH_MAJOR, TPInfo->pt[i].Pressure); + input_report_abs(ts->input_dev, ABS_MT_WIDTH_MAJOR, TPInfo->pt[i].Width); + input_report_abs(ts->input_dev, ABS_MT_WIDTH_MINOR, TPInfo->pt[i].Height); + input_report_abs(ts->input_dev, ABS_MT_POSITION_X, TPInfo->pt[i].x); + input_report_abs(ts->input_dev, ABS_MT_POSITION_Y, TPInfo->pt[i].y); + input_report_abs(ts->input_dev, ABS_MT_TRACKING_ID, TPInfo->pt[i].id); /* Android 2.3 */ + input_mt_sync(ts->input_dev); + i++; + } + while ((i < TPInfo->fingers) && (i < MAX_FINGERS)); #endif + input_sync(ts->input_dev); + +err_free_allocate: + + if (ts->use_irq) + { +/* case 1 mode */ +#ifdef _INT_MODE_1 + /*TODO: After interrupt status low, read i2c bus data by polling, until interrupt status is high */ + ret = check_gpio_interrupt(); /* interrupt pin is still LOW, read data until interrupt pin is released. */ + if (!ret) + { + hrtimer_start(&ts->timer, ktime_set(0, TIMER_NS), HRTIMER_MODE_REL); + } + else + { + if (TPInfo->pre_keybit_state) + { + ts_report_key(ts->client, 0x0); /* clear for interrupt */ + } + +#if ( LINUX_VERSION_CODE < KERNEL_VERSION (2, 6, 39) ) + if ((ts->desc->status & IRQ_DISABLED) == IRQ_STATUS_DISABLED) +#else + if ((ts->desc->irq_data.state_use_accessors & +IRQD_IRQ_DISABLED) == IRQ_STATUS_DISABLED) #endif + { + enable_irq(ts->client->irq); + } + } +/* case 2 mode */ +#else + +#if ( LINUX_VERSION_CODE < KERNEL_VERSION (2, 6, 39) ) + if ((ts->desc->status & IRQ_DISABLED) == IRQ_STATUS_DISABLED) #else + if ((ts->desc->irq_data.state_use_accessors & IRQD_IRQ_DISABLED) == +IRQ_STATUS_DISABLED) #endif + { + enable_irq(ts->client->irq); + } +#endif + } + + mutex_unlock(&ts->mutex_wq); + return; +} + +static void sis_tpinfo_clear(struct sisTP_driver_data *TPInfo, int max) +{ + int i = 0; + for(i = 0; i < max; i++) + { + TPInfo->pt[i].id = -1; + TPInfo->pt[i].x = 0; + TPInfo->pt[i].y = 0; + TPInfo->pt[i].Pressure = 0; + TPInfo->pt[i].Width = 0; + } + TPInfo->id = 0x0; + TPInfo->fingers = 0; +} + +static enum hrtimer_restart sis_ts_timer_func(struct hrtimer *timer) { + struct sis_ts_data *ts = container_of(timer, struct sis_ts_data, timer); + queue_work(sis_wq, &ts->work); + if (!ts->use_irq) + { /* For Polling mode */ + hrtimer_start(&ts->timer, ktime_set(0, TIMER_NS), HRTIMER_MODE_REL); + } + return HRTIMER_NORESTART; +} + +static irqreturn_t sis_ts_irq_handler(int irq, void *dev_id) { + struct sis_ts_data *ts = dev_id; + +#if ( LINUX_VERSION_CODE < KERNEL_VERSION (2, 6, 39) ) + if ((ts->desc->status & IRQ_DISABLED) == IRQ_STATUS_ENABLED) #else + if ((ts->desc->irq_data.state_use_accessors & IRQD_IRQ_DISABLED) == +IRQ_STATUS_ENABLED) #endif + { + disable_irq_nosync(ts->client->irq); + } + queue_work(sis_wq, &ts->work); + + return IRQ_HANDLED; +} + +static int initial_irq(void) +{ + int ret = 0; +#ifdef _I2C_INT_ENABLE + /* initialize gpio and interrupt pins */ + ret = gpio_request(GPIO_IRQ, "GPIO_133"); /* ex. GPIO_133 for interrupt mode */ + if (ret < 0) + { + /* Set Active Low. Please reference the file include/linux/interrupt.h */ + } + /* setting gpio direction here OR boardinfo file*/ + +#else + ret = -1; +#endif + return ret; +} + +uint16_t cal_crc (char* cmd, int start, int end) { + int i = 0; + uint16_t crc = 0; + + for (i = start; i <= end ; i++) + { + crc = (crc<<8) ^ crc16tab[((crc>>8) ^ cmd[i] )&0x00FF]; + } + + return crc; +} + +uint16_t cal_crc_with_cmd (char* data, int start, int end, uint8_t cmd) +{ + int i = 0; + uint16_t crc = 0; + + crc = (crc<<8) ^ crc16tab[((crc>>8) ^ cmd)&0x00FF]; + for (i = start; i <= end ; i++) + { + crc = (crc<<8) ^ crc16tab[((crc>>8) ^ data[i] )&0x00FF]; + } + + return crc; +} + +void write_crc (unsigned char *buf, int start, int end) { + uint16_t crc = 0; + + crc = cal_crc (buf, start , end); + buf[end+1] = (crc >> 8)& 0xff; + buf[end+2] = crc & 0xff; +} + +#ifdef _STD_RW_IO +#define BUFFER_SIZE MAX_BYTE +static ssize_t sis_cdev_write( struct file *file, const char __user +*buf, size_t count, loff_t *f_pos ) { + int ret = 0; + char *kdata; + char cmd; + + printk(KERN_INFO "sis_cdev_write.\n"); + + if (ts_bak == 0) + return -13; + + ret = access_ok(VERIFY_WRITE, buf, BUFFER_SIZE); + if (!ret) { + printk(KERN_ERR "cannot access user space memory\n"); + return -11; + } + + kdata = kmalloc(BUFFER_SIZE, GFP_KERNEL); + if (kdata == 0) + return -12; + + ret = copy_from_user(kdata, buf, BUFFER_SIZE); + if (ret) { + printk(KERN_ERR "copy_from_user fail\n"); + kfree(kdata); + return -14; + } +#if 0 + PrintBuffer(0, count, kdata); +#endif + + cmd = kdata[6]; + +/* Write & Read */ + ret = sis_command_for_write(ts_bak->client, count, kdata); + if (ret < 0) { + printk(KERN_ERR "i2c_transfer write error %d\n", ret); + kfree(kdata); + return -21; + } + + if ( copy_to_user((char*) buf, kdata, BUFFER_SIZE ) ) + { + printk(KERN_ERR "copy_to_user fail\n" ); + ret = -19; + } + + kfree( kdata ); + + return ret; +} + +/* for get system time */ +static ssize_t sis_cdev_read( struct file *file, char __user *buf, +size_t count, loff_t *f_pos ) { + int ret = 0; + char *kdata; + char cmd; + int i; + + printk(KERN_INFO "sis_cdev_read.\n"); + + if (ts_bak == 0) + return -13; + + ret = access_ok(VERIFY_WRITE, buf, BUFFER_SIZE); + if (!ret) { + printk(KERN_ERR "cannot access user space memory\n"); + return -11; + } + + kdata = kmalloc(BUFFER_SIZE, GFP_KERNEL); + if (kdata == 0) + return -12; + + ret = copy_from_user(kdata, buf, BUFFER_SIZE); + if (ret) { + printk(KERN_ERR "copy_from_user fail\n"); + kfree(kdata); + return -14; + } +#if 0 + PrintBuffer(0, count, kdata); +#endif + cmd = kdata[6]; + /* for making sure AP communicates with SiS driver */ + if(cmd == 0xa2) + { + kdata[0] = 5; + kdata[1] = 0; + kdata[3] = 'S'; + kdata[4] = 'i'; + kdata[5] = 'S'; + if ( copy_to_user((char*) buf, kdata, BUFFER_SIZE ) ) + { + printk(KERN_ERR "copy_to_user fail\n" ); + kfree( kdata ); + return -19; + } + + kfree( kdata ); + return 3; + } +/* Write & Read */ + ret = sis_command_for_read(ts_bak->client, MAX_BYTE, kdata); + if (ret < 0) { + printk(KERN_ERR "i2c_transfer read error %d\n", ret); + kfree(kdata); + return -21; + } + + ret = kdata[0] | (kdata[1] << 8); + + printk(KERN_INFO "%d\n", ret); + + for ( i = 0; i < ret && i < BUFFER_SIZE; i++ ) + { + printk("%02x ", kdata[i]); + } + + printk( "\n" ); + + if ( copy_to_user((char*) buf, kdata, BUFFER_SIZE ) ) + { + printk(KERN_ERR "copy_to_user fail\n" ); + ret = -19; + } + + kfree( kdata ); + + return ret; +} + +#undef BUFFER_SIZE + +static int sis_cdev_open(struct inode *inode, struct file *filp) { + printk(KERN_INFO "sis_cdev_open.\n"); + if ( ts_bak == 0 ) + return -13; + + msleep(200); + if (ts_bak->use_irq) + { +#if ( LINUX_VERSION_CODE < KERNEL_VERSION (2, 6, 39) ) + if ((ts_bak->desc->status & IRQ_DISABLED) == +IRQ_STATUS_ENABLED) #else + if ((ts_bak->desc->irq_data.state_use_accessors & IRQD_IRQ_DISABLED) == IRQ_STATUS_ENABLED) +#endif + { + disable_irq(ts_bak->client->irq); + } + else + { +#if ( LINUX_VERSION_CODE < KERNEL_VERSION (2, 6, 39) ) + printk(KERN_INFO "sis_cdev_open: IRQ_STATUS: +%x\n",(ts_bak->desc->status & IRQ_DISABLED)); #else + printk(KERN_INFO "sis_cdev_open: IRQ_STATUS: %x\n",(ts_bak->desc->irq_data.state_use_accessors & IRQD_IRQ_DISABLED)); +#endif + } + } + hrtimer_cancel(&ts_bak->timer); + + /* only flush sis_wq */ + flush_workqueue(sis_wq); + + msleep(200); + + return 0; /* success */ +} + +static int sis_cdev_release(struct inode *inode, struct file *filp) { + printk(KERN_INFO "sis_cdev_release.\n"); + + msleep(200); + + if (ts_bak == 0) + return -13; + + if (ts_bak->use_irq) + { +#if ( LINUX_VERSION_CODE < KERNEL_VERSION (2, 6, 39) ) + if ((ts_bak->desc->status & IRQ_DISABLED) == +IRQ_STATUS_DISABLED) #else + if ((ts_bak->desc->irq_data.state_use_accessors & IRQD_IRQ_DISABLED) == IRQ_STATUS_DISABLED) +#endif + { + enable_irq(ts_bak->client->irq); + } + } + else + hrtimer_start(&ts_bak->timer, ktime_set(1, 0), HRTIMER_MODE_REL); + + return 0; +} + +static const struct file_operations sis_cdev_fops = { + .owner = THIS_MODULE, + .read = sis_cdev_read, + .write = sis_cdev_write, + .open = sis_cdev_open, + .release= sis_cdev_release, +}; + +static int sis_setup_chardev(struct sis_ts_data *ts) { + + dev_t dev = MKDEV(sis_char_major, 0); + int alloc_ret = 0; + int cdev_err = 0; + int input_err = 0; + struct device *class_dev = NULL; + void *ptr_err; + + printk("sis_setup_chardev.\n"); + + if (ts == NULL) + { + input_err = -ENOMEM; + goto error; + } + /* dynamic allocate driver handle */ + alloc_ret = alloc_chrdev_region(&dev, 0, sis_char_devs_count, DEVICE_NAME); + if (alloc_ret) + goto error; + + sis_char_major = MAJOR(dev); + cdev_init(&sis_char_cdev, &sis_cdev_fops); + sis_char_cdev.owner = THIS_MODULE; + cdev_err = cdev_add(&sis_char_cdev, MKDEV(sis_char_major, 0), +sis_char_devs_count); + + if (cdev_err) + goto error; + + printk(KERN_INFO "%s driver(major %d) installed.\n", DEVICE_NAME, +sis_char_major); + + /* register class */ + sis_char_class = class_create(THIS_MODULE, DEVICE_NAME); + if(IS_ERR(ptr_err = sis_char_class)) + { + goto err2; + } + + class_dev = device_create(sis_char_class, NULL, MKDEV(sis_char_major, +0), NULL, DEVICE_NAME); + + if(IS_ERR(ptr_err = class_dev)) + { + goto err; + } + + return 0; +error: + if (cdev_err == 0) + cdev_del(&sis_char_cdev); + if (alloc_ret == 0) + unregister_chrdev_region(MKDEV(sis_char_major, 0), sis_char_devs_count); + if(input_err != 0) + { + printk("sis_ts_bak error!\n"); + } +err: + device_destroy(sis_char_class, MKDEV(sis_char_major, 0)); +err2: + class_destroy(sis_char_class); + return -1; +} +#endif + +static int sis_ts_probe( + struct i2c_client *client, const struct i2c_device_id *id) { + int ret = 0; + struct sis_ts_data *ts = NULL; + struct sis_i2c_rmi_platform_data *pdata = NULL; + + printk(KERN_INFO "sis_ts_probe\n"); + + TPInfo = kzalloc(sizeof(struct sisTP_driver_data), GFP_KERNEL); + if (TPInfo == NULL) + { + ret = -ENOMEM; + goto err_alloc_data_failed; + } + + ts = kzalloc(sizeof(struct sis_ts_data), GFP_KERNEL); + if (ts == NULL) + { + ret = -ENOMEM; + goto err_alloc_data_failed; + } + + ts_bak = ts; + + mutex_init(&ts->mutex_wq); + + /* 1. Init Work queue and necessary buffers */ + INIT_WORK(&ts->work, sis_ts_work_func); + ts->client = client; + i2c_set_clientdata(client, ts); + pdata = client->dev.platform_data; + + if (pdata) + ts->power = pdata->power; + if (ts->power) + { + ret = ts->power(1); + if (ret < 0) + { + printk(KERN_ERR "sis_ts_probe power on failed\n"); + goto err_power_failed; + } + } + + /* 2. Allocate input device */ + ts->input_dev = input_allocate_device(); + if (ts->input_dev == NULL) + { + ret = -ENOMEM; + printk(KERN_ERR "sis_ts_probe: Failed to allocate input device\n"); + goto err_input_dev_alloc_failed; + } + + /* This input device name should be the same to IDC file name. */ + ts->input_dev->name = "sis_touch"; + + set_bit(EV_ABS, ts->input_dev->evbit); + set_bit(EV_KEY, ts->input_dev->evbit); + set_bit(ABS_MT_POSITION_X, ts->input_dev->absbit); + set_bit(ABS_MT_POSITION_Y, ts->input_dev->absbit); + set_bit(ABS_MT_TRACKING_ID, ts->input_dev->absbit); + +#ifdef _ANDROID_4 + set_bit(INPUT_PROP_DIRECT, ts->input_dev->propbit); + set_bit(ABS_MT_PRESSURE, ts->input_dev->absbit); + set_bit(ABS_MT_TOUCH_MAJOR, ts->input_dev->absbit); + set_bit(ABS_MT_TOUCH_MINOR, ts->input_dev->absbit); + input_set_abs_params(ts->input_dev, ABS_MT_PRESSURE, 0, PRESSURE_MAX, 0, 0); + input_set_abs_params(ts->input_dev, ABS_MT_TOUCH_MAJOR, 0, AREA_LENGTH_LONGER, 0, 0); + input_set_abs_params(ts->input_dev, ABS_MT_TOUCH_MINOR, 0, AREA_LENGTH_SHORT, 0, 0); +#else + set_bit(ABS_MT_TOUCH_MAJOR, ts->input_dev->absbit); + set_bit(ABS_MT_WIDTH_MAJOR, ts->input_dev->absbit); + set_bit(ABS_MT_WIDTH_MINOR, ts->input_dev->absbit); + input_set_abs_params(ts->input_dev, ABS_MT_TOUCH_MAJOR, 0, PRESSURE_MAX, 0, 0); + input_set_abs_params(ts->input_dev, ABS_MT_WIDTH_MAJOR, 0, AREA_LENGTH_LONGER, 0, 0); + input_set_abs_params(ts->input_dev, ABS_MT_WIDTH_MINOR, 0, +AREA_LENGTH_SHORT, 0, 0); #endif + + input_set_abs_params(ts->input_dev, ABS_MT_POSITION_X, 0, SIS_MAX_X, 0, 0); + input_set_abs_params(ts->input_dev, ABS_MT_POSITION_Y, 0, SIS_MAX_Y, 0, 0); + input_set_abs_params(ts->input_dev, ABS_MT_TRACKING_ID, 0, 15, 0, + 0); + + /* add for touch keys */ + set_bit(KEY_COMPOSE, ts->input_dev->keybit); + set_bit(KEY_BACK, ts->input_dev->keybit); + set_bit(KEY_MENU, ts->input_dev->keybit); + set_bit(KEY_HOME, ts->input_dev->keybit); + + /* 3. Register input device to core */ + ret = input_register_device(ts->input_dev); + + if (ret) + { + printk(KERN_ERR "sis_ts_probe: Unable to register %s input device\n", ts->input_dev->name); + goto err_input_register_device_failed; + } + + /* 4. irq or timer setup */ + ret = initial_irq(); + if (ret < 0) + { + + } + else + { + client->irq = gpio_to_irq(GPIO_IRQ); + ret = request_irq(client->irq, sis_ts_irq_handler, IRQF_TRIGGER_FALLING, client->name, ts); + if (ret == 0) + { + ts->use_irq = 1; + } + else + { + dev_err(&client->dev, "request_irq failed\n"); + } + } + + ts->desc = irq_to_desc(ts_bak->client->irq); + + hrtimer_init(&ts->timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL); + ts->timer.function = sis_ts_timer_func; + + if (!ts->use_irq) + { + hrtimer_start(&ts->timer, ktime_set(1, 0), HRTIMER_MODE_REL); + } + +#ifdef CONFIG_HAS_EARLYSUSPEND + ts->early_suspend.level = EARLY_SUSPEND_LEVEL_BLANK_SCREEN + 1; + ts->early_suspend.suspend = sis_ts_early_suspend; + ts->early_suspend.resume = sis_ts_late_resume; + register_early_suspend(&ts->early_suspend); +#endif + printk(KERN_INFO "sis_ts_probe: Start touchscreen %s in %s mode\n", +ts->input_dev->name, ts->use_irq ? "interrupt" : "polling"); + + if (ts->use_irq) + { +#ifdef _INT_MODE_1 + printk(KERN_INFO "sis_ts_probe: interrupt case 1 mode\n"); #else + printk(KERN_INFO "sis_ts_probe: interrupt case 2 mode\n"); #endif + } + +#ifdef _STD_RW_IO + ret = sis_setup_chardev(ts); + if(ret) + { + printk( KERN_INFO"sis_setup_chardev fail\n"); + } +#endif + + printk( KERN_INFO"sis SIS_SLAVE_ADDR: %d\n", SIS_SLAVE_ADDR); + + return 0; + +err_input_register_device_failed: + input_free_device(ts->input_dev); + +err_input_dev_alloc_failed: +err_power_failed: + kfree(ts); +err_alloc_data_failed: + return ret; +} + +static int sis_ts_remove(struct i2c_client *client) { + struct sis_ts_data *ts = i2c_get_clientdata(client); + +#ifdef CONFIG_HAS_EARLYSUSPEND + unregister_early_suspend(&ts->early_suspend); +#endif + if (ts->use_irq) + free_irq(client->irq, ts); + else + hrtimer_cancel(&ts->timer); + input_unregister_device(ts->input_dev); + kfree(ts); + + return 0; +} + +static int sis_ts_suspend(struct i2c_client *client, pm_message_t mesg) +{ + int ret = 0; + struct sis_ts_data *ts = i2c_get_clientdata(client); + + TPInfo->pre_keybit_state = 0x0; + + if (ts->use_irq) + { +#if ( LINUX_VERSION_CODE < KERNEL_VERSION (2, 6, 39) ) + if ((ts->desc->status & IRQ_DISABLED) == IRQ_STATUS_ENABLED) #else + if ((ts->desc->irq_data.state_use_accessors & IRQD_IRQ_DISABLED) == +IRQ_STATUS_ENABLED) #endif + { + disable_irq(client->irq); + } + } + else + hrtimer_cancel(&ts->timer); + /* only flush sis_wq */ + flush_workqueue(sis_wq); + + if (ts->power) { + ret = ts->power(0); + if (ret < 0) + printk(KERN_ERR "sis_ts_suspend power off failed\n"); + } + + return 0; +} + +static int sis_ts_resume(struct i2c_client *client) { + int ret = 0; + struct sis_ts_data *ts = i2c_get_clientdata(client); + + if (ts->power) + { + ret = ts->power(1); + if (ret < 0) + printk(KERN_ERR "sis_ts_resume power on failed\n"); + } + + if (ts->use_irq) + { +#if ( LINUX_VERSION_CODE < KERNEL_VERSION (2, 6, 39) ) + if ((ts->desc->status & IRQ_DISABLED) == IRQ_STATUS_DISABLED) #else + if ((ts->desc->irq_data.state_use_accessors & IRQD_IRQ_DISABLED) == +IRQ_STATUS_DISABLED) #endif + { + enable_irq(client->irq); + } + } + else + hrtimer_start(&ts->timer, ktime_set(1, 0), HRTIMER_MODE_REL); + + return 0; +} + +#ifdef CONFIG_HAS_EARLYSUSPEND +static void sis_ts_early_suspend(struct early_suspend *h) { + struct sis_ts_data *ts; + + TPInfo->pre_keybit_state = 0x0; + ts = container_of(h, struct sis_ts_data, early_suspend); + sis_ts_suspend(ts->client, PMSG_SUSPEND); } + +static void sis_ts_late_resume(struct early_suspend *h) { + struct sis_ts_data *ts; + + ts = container_of(h, struct sis_ts_data, early_suspend); + sis_ts_resume(ts->client); +} +#endif + +static const struct i2c_device_id sis_ts_id[] = { + { SIS_I2C_NAME, 0 }, + { } +}; + +MODULE_DEVICE_TABLE(i2c, sis_ts_id); + +static struct i2c_driver sis_ts_driver = { + .probe = sis_ts_probe, + .remove = sis_ts_remove, +#ifndef CONFIG_HAS_EARLYSUSPEND + .suspend = sis_ts_suspend, + .resume = sis_ts_resume, +#endif +#ifdef CONFIG_X86 + .class = I2C_CLASS_HWMON, + .detect = sis_ts_detect, + .address_list = normal_i2c, +#endif + .id_table = sis_ts_id, + .driver = { + .name = SIS_I2C_NAME, + }, +}; + +static int __init sis_ts_init(void) +{ + printk( KERN_INFO "sis_ts_init\n" ); + + sis_wq = create_singlethread_workqueue("sis_wq"); + + if (!sis_wq) + return -ENOMEM; + + return i2c_add_driver(&sis_ts_driver); } + +#ifdef CONFIG_X86 +/* Return 0 if detection is successful, -ENODEV otherwise */ static int +sis_ts_detect(struct i2c_client *client, + struct i2c_board_info *info) +{ + const char *type_name; + + printk(KERN_INFO "sis_ts_detect\n"); + + type_name = "sis_i2c_ts"; + strlcpy(info->type, type_name, I2C_NAME_SIZE); + + return 0; +} +#endif + +static void __exit sis_ts_exit(void) +{ +#ifdef _STD_RW_IO + dev_t dev; +#endif + + printk(KERN_INFO "sis_ts_exit\n"); + + i2c_del_driver(&sis_ts_driver); + + if (sis_wq) + destroy_workqueue(sis_wq); + +#ifdef _STD_RW_IO + dev = MKDEV(sis_char_major, 0); + cdev_del(&sis_char_cdev); + unregister_chrdev_region(dev, sis_char_devs_count); + device_destroy(sis_char_class, MKDEV(sis_char_major, 0)); + class_destroy(sis_char_class); +#endif +} + +module_init(sis_ts_init); +module_exit(sis_ts_exit); +MODULE_DESCRIPTION("SiS 9200 Family Touchscreen Driver"); +MODULE_LICENSE("GPL"); diff --git a/linux-3.18.1/drivers/input/touchscreen/sis_i2c.h b/linux-3.18.1/drivers/input/touchscreen/sis_i2c.h new file mode 100644 index 0000000..c1d65c4 --- /dev/null +++ b/linux-3.18.1/drivers/input/touchscreen/sis_i2c.h @@ -0,0 +1,215 @@ +/* + * include/linux/sis_i2c.h - platform data structure for SiS 9200 +family + * + * Copyright (C) 2011 SiS, Inc. + * + * This software is licensed under the terms of the GNU General Public + * License version 2, as published by the Free Software Foundation, and + * may be copied, distributed, and modified under those terms. + * + * 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. + * + * Date: 2015/01/15 + * Version: Android_v2.05.00-A639-1113 + */ +#include + +#ifndef _LINUX_SIS_I2C_H +#define _LINUX_SIS_I2C_H + + +#define SIS_I2C_NAME "sis_i2c_ts" +#define SIS_SLAVE_ADDR 0x5c +#define TIMER_NS 10000000 //10ms +#define MAX_FINGERS 10 + + +/* For Android 4.0 */ +/* Only for Linux kernel 2.6.34 and later */ +#define _ANDROID_4 // ON/OFF + +/* For standard R/W IO*/ +#define _STD_RW_IO // ON/OFF + +/* Interrupt setting and modes */ +#define _I2C_INT_ENABLE // ON/OFF +#define GPIO_IRQ 133 + +/* Enable if use interrupt case 1 mode. */ +/* Disable if use interrupt case 2 mode. */ +//#define _INT_MODE_1 // ON/OFF + +/* IRQ STATUS */ +#if ( LINUX_VERSION_CODE < KERNEL_VERSION (2, 6, 39) ) +#define IRQ_STATUS_DISABLED 0x200 +#else +#define IRQ_STATUS_DISABLED (1<<16) +#endif +#define IRQ_STATUS_ENABLED 0x0 + +/* Resolution mode */ +// Constant value +#define SIS_MAX_X 4095 +#define SIS_MAX_Y 4095 + +#define ONE_BYTE 1 +#define FIVE_BYTE 5 +#define EIGHT_BYTE 8 +#define SIXTEEN_BYTE 16 +#define PACKET_BUFFER_SIZE 128 + +#define SIS_CMD_NORMAL 0x0 +#define SIS_CMD_SOFTRESET 0x82 +#define SIS_CMD_RECALIBRATE 0x87 +#define SIS_CMD_POWERMODE 0x90 +#define MSK_TOUCHNUM 0x0f +#define MSK_HAS_CRC 0x10 +#define MSK_DATAFMT 0xe0 +#define MSK_PSTATE 0x0f +#define MSK_PID 0xf0 +#define RES_FMT 0x00 +#define FIX_FMT 0x40 + +/* for new i2c format */ +#define TOUCHDOWN 0x3 +#define TOUCHUP 0x0 +#define MAX_BYTE 64 +#define PRESSURE_MAX 255 + +#ifdef _ANDROID_4 +#define AREA_LENGTH_LONGER 5792 //Resolution diagonal +#define AREA_LENGTH_SHORT 5792 // ((SIS_MAX_X^2) + (SIS_MAX_Y^2))^0.5 +#define AREA_UNIT (5792/32) +#else +#define AREA_LENGTH_LONGER 31 +#define AREA_LENGTH_SHORT 31 +#endif + + +#define FORMAT_MODE 1 + +#define MSK_NOBTN 0 +#define MSK_COMP 1 +#define MSK_BACK 2 +#define MSK_MENU 4 +#define MSK_HOME 8 + +#define P_BYTECOUNT 0 +#define ALL_IN_ONE_PACKAGE 0x10 +#define IS_TOUCH(x) (x & 0x1) +#define IS_HIDI2C(x) (x & 0x6) +#define IS_AREA(x) ((x >> 4) & 0x1) +#define IS_PRESSURE(x) ((x >> 5) & 0x1) +#define IS_SCANTIME(x) ((x >> 6) & 0x1) +//#define _DEBUG_PACKAGE // ON/OFF +//#define _DEBUG_REPORT // ON/OFF +#define NORMAL_LEN_PER_POINT 6 +#define AREA_LEN_PER_POINT 2 +#define PRESSURE_LEN_PER_POINT 1 + +//#define _CHECK_CRC // ON/OFF +//#define _SUPPORT_BUTTON_TOUCH // ON/OFF +#define TOUCH_FORMAT 0x1 +#define BUTTON_FORMAT 0x4 +#define HIDI2C_FORMAT 0x6 +#define P_REPORT_ID 2 +#define BUTTON_STATE 3 +#define BUTTON_KEY_COUNT 16 +#define BYTE_BYTECOUNT 2 +#define BYTE_COUNT 1 +#define BYTE_ReportID 1 +#define BYTE_CRC_HIDI2C 0 +#define BYTE_CRC_I2C 2 +#define BYTE_SCANTIME 2 +#define NO_TOUCH_BYTECOUNT 0x3 + +/* TODO */ +#define TOUCH_POWER_PIN 0 +#define TOUCH_RESET_PIN 1 + +/* CMD Define */ +#define BUF_ACK_PLACE_L 4 +#define BUF_ACK_PLACE_H 5 +#define BUF_ACK_L 0xEF +#define BUF_ACK_H 0xBE +#define BUF_NACK_L 0xAD +#define BUF_NACK_H 0xDE +#define BUF_CRC_PLACE 7 + + + +struct sis_i2c_rmi_platform_data { + int (*power)(int on); /* Only valid in first array entry */ +}; + +static const unsigned short crc16tab[256]= { + 0x0000,0x1021,0x2042,0x3063,0x4084,0x50a5,0x60c6,0x70e7, + 0x8108,0x9129,0xa14a,0xb16b,0xc18c,0xd1ad,0xe1ce,0xf1ef, + 0x1231,0x0210,0x3273,0x2252,0x52b5,0x4294,0x72f7,0x62d6, + 0x9339,0x8318,0xb37b,0xa35a,0xd3bd,0xc39c,0xf3ff,0xe3de, + 0x2462,0x3443,0x0420,0x1401,0x64e6,0x74c7,0x44a4,0x5485, + 0xa56a,0xb54b,0x8528,0x9509,0xe5ee,0xf5cf,0xc5ac,0xd58d, + 0x3653,0x2672,0x1611,0x0630,0x76d7,0x66f6,0x5695,0x46b4, + 0xb75b,0xa77a,0x9719,0x8738,0xf7df,0xe7fe,0xd79d,0xc7bc, + 0x48c4,0x58e5,0x6886,0x78a7,0x0840,0x1861,0x2802,0x3823, + 0xc9cc,0xd9ed,0xe98e,0xf9af,0x8948,0x9969,0xa90a,0xb92b, + 0x5af5,0x4ad4,0x7ab7,0x6a96,0x1a71,0x0a50,0x3a33,0x2a12, + 0xdbfd,0xcbdc,0xfbbf,0xeb9e,0x9b79,0x8b58,0xbb3b,0xab1a, + 0x6ca6,0x7c87,0x4ce4,0x5cc5,0x2c22,0x3c03,0x0c60,0x1c41, + 0xedae,0xfd8f,0xcdec,0xddcd,0xad2a,0xbd0b,0x8d68,0x9d49, + 0x7e97,0x6eb6,0x5ed5,0x4ef4,0x3e13,0x2e32,0x1e51,0x0e70, + 0xff9f,0xefbe,0xdfdd,0xcffc,0xbf1b,0xaf3a,0x9f59,0x8f78, + 0x9188,0x81a9,0xb1ca,0xa1eb,0xd10c,0xc12d,0xf14e,0xe16f, + 0x1080,0x00a1,0x30c2,0x20e3,0x5004,0x4025,0x7046,0x6067, + 0x83b9,0x9398,0xa3fb,0xb3da,0xc33d,0xd31c,0xe37f,0xf35e, + 0x02b1,0x1290,0x22f3,0x32d2,0x4235,0x5214,0x6277,0x7256, + 0xb5ea,0xa5cb,0x95a8,0x8589,0xf56e,0xe54f,0xd52c,0xc50d, + 0x34e2,0x24c3,0x14a0,0x0481,0x7466,0x6447,0x5424,0x4405, + 0xa7db,0xb7fa,0x8799,0x97b8,0xe75f,0xf77e,0xc71d,0xd73c, + 0x26d3,0x36f2,0x0691,0x16b0,0x6657,0x7676,0x4615,0x5634, + 0xd94c,0xc96d,0xf90e,0xe92f,0x99c8,0x89e9,0xb98a,0xa9ab, + 0x5844,0x4865,0x7806,0x6827,0x18c0,0x08e1,0x3882,0x28a3, + 0xcb7d,0xdb5c,0xeb3f,0xfb1e,0x8bf9,0x9bd8,0xabbb,0xbb9a, + 0x4a75,0x5a54,0x6a37,0x7a16,0x0af1,0x1ad0,0x2ab3,0x3a92, + 0xfd2e,0xed0f,0xdd6c,0xcd4d,0xbdaa,0xad8b,0x9de8,0x8dc9, + 0x7c26,0x6c07,0x5c64,0x4c45,0x3ca2,0x2c83,0x1ce0,0x0cc1, + 0xef1f,0xff3e,0xcf5d,0xdf7c,0xaf9b,0xbfba,0x8fd9,0x9ff8, + 0x6e17,0x7e36,0x4e55,0x5e74,0x2e93,0x3eb2,0x0ed1,0x1ef0 +}; + +struct Point { + int id; + unsigned short x, y; // uint16_t ? + uint16_t Pressure; + uint16_t Width; + uint16_t Height; +}; + +struct sisTP_driver_data { + int id; + int fingers; + uint8_t pre_keybit_state; + struct Point pt[MAX_FINGERS]; +}; + +struct sis_ts_data { + int (*power)(int on); + int use_irq; + struct i2c_client *client; + struct input_dev *input_dev; + struct hrtimer timer; + struct irq_desc *desc; + struct work_struct work; + struct mutex mutex_wq; +#ifdef CONFIG_HAS_EARLYSUSPEND + struct early_suspend early_suspend; +#endif +}; + +static int sis_ts_suspend(struct i2c_client *client, pm_message_t +mesg); static int sis_ts_resume(struct i2c_client *client); + +#endif /* _LINUX_SIS_I2C_H */ {.n++%ݶw{.n+{G{ayʇڙ,jfhz_(階ݢj"mG?&~iOzv^m ?I From mboxrd@z Thu Jan 1 00:00:00 1970 From: =?utf-8?B?5pu+5am36JGzICh0YW1teV90c2VuZyk=?= Subject: RE: [PATCH 1/2] INPUT/HID: add touch support for SiS touch driver Date: Fri, 16 Jan 2015 19:19:49 +0800 Message-ID: <8322374EB97AA24A95D0DDBFC8F1CA1DBF9E1F@SISMBEV01.sis.com.tw> References: <8322374EB97AA24A95D0DDBFC8F1CA1DBF987B@SISMBEV01.sis.com.tw><1421063449.12454.17.camel@linux-0dmf.site> <8322374EB97AA24A95D0DDBFC8F1CA1DBF9DE5@SISMBEV01.sis.com.tw> Mime-Version: 1.0 Content-Type: text/plain; charset="utf-8" Content-Transfer-Encoding: base64 Return-path: Received: from m01.upixeltek.com ([203.67.208.22]:52152 "EHLO sism01.sis.com" rhost-flags-OK-FAIL-OK-OK) by vger.kernel.org with ESMTP id S1751363AbbAPLUE (ORCPT ); Fri, 16 Jan 2015 06:20:04 -0500 Content-class: urn:content-classes:message Sender: linux-input-owner@vger.kernel.org List-Id: linux-input@vger.kernel.org To: Oliver Neukum , linux-kernel@vger.kernel.org, linux-input@vger.kernel.org Cc: tammy0524@gmail.com SGV5LCBPbGl2ZXINCg0KT24gTW9uLCBKYW4gMTIsIDIwMTUgYXQgNzo1MCBQTSwgT2xpdmVyIE5l dWt1bSA8b25ldWt1bUBzdXNlLmRlPiB3cm90ZToNCk9uIE1vbiwgMjAxNS0wMS0xMiBhdCAxODo1 MyArMDgwMCwg5pu+5am36JGzICh0YW1teV90c2VuZykgd3JvdGU6DQo+ID4gKFNraXAgdGhlIGNv ZGUgZGlmZi4uLikNCj4gDQo+IEFnYWluIG1hY3JvcyBmb3IgZW5kaWFubmVzcw0KPiANCj4gQW5k IHRoZSBkcml2ZXIgaGFzIGEgZ3JlYXQgbnVtYmVyIG9mIGNvbmRpdGlvbmFsIGNvbXBpbGF0aW9u cyBhcmUgdGhleSANCj4gcmVhbGx5IG5lZWRlZD8gVGhlIGRyaXZlciBhcyBpcyBoYXMgYSBudW1i ZXIgb2YgaXNzdWVzIGFuZCBpcyBoYXJkIHRvIA0KPiByZXZpZXcgZHVlIHRvIHRoZSB1c2Ugb2Yg Ii8vIiBmb3IgY29tbWVudHMgYW5kIGEgbG90IG9mIGNvbmRpdGlvbmFsIA0KPiBjb21waWxhdGlv biBhbmQgdW5uZWNlc3NhcnkgdmFyaWFibGVzIHVzZWQgZm9yIGNvbnN0YW50cy4gQ291bGQgeW91 IA0KPiBmaXggdGhpcyB1cCBhbmQgcmVzdWJtaXQ/DQoNClRoYW5rcyBmb3IgdGhlIHJlcGx5LiBJ J3ZlIG1vZGlmaWVkIHRoZSBjb2RlIChzaXNfaTJjLmMvc2lzX2kyYy5oL0tjb25maWcvTWFrZWZp bGUpIHRvIGZpeCB0aGVtLg0KUGxlYXNlIGhlbHAgY2hlY2sgdGhlbSBpZiBhbnl0aGluZyBuZWVk cyB0byBmaXguDQpUaGFua3MuDQoNClRhbW15DQoNCi0tLQ0KZGlmZiAtLWdpdCBhL2xpbnV4LTMu MTguMS9kcml2ZXJzL2lucHV0L3RvdWNoc2NyZWVuL0tjb25maWcgYi9saW51eC0zLjE4LjEvZHJp dmVycy9pbnB1dC90b3VjaHNjcmVlbi9LY29uZmlnDQppbmRleCBlMWQ4MDAzLi40MDFjZDhiIDEw MDY0NA0KLS0tIGEvbGludXgtMy4xOC4xL2RyaXZlcnMvaW5wdXQvdG91Y2hzY3JlZW4vS2NvbmZp Zw0KKysrIGIvbGludXgtMy4xOC4xL2RyaXZlcnMvaW5wdXQvdG91Y2hzY3JlZW4vS2NvbmZpZw0K QEAgLTk2Miw0ICs5NjIsMTIgQEAgY29uZmlnIFRPVUNIU0NSRUVOX1pGT1JDRQ0KIAkgIFRvIGNv bXBpbGUgdGhpcyBkcml2ZXIgYXMgYSBtb2R1bGUsIGNob29zZSBNIGhlcmU6IHRoZQ0KIAkgIG1v ZHVsZSB3aWxsIGJlIGNhbGxlZCB6Zm9yY2VfdHMuDQogDQorY29uZmlnIFRPVUNIU0NSRUVOX1NJ U19JMkMNCisJdHJpc3RhdGUgIlNpUyA5MjAwIGZhbWlseSBJMkMgdG91Y2hzY3JlZW4gZHJpdmVy Ig0KKwlkZXBlbmRzIG9uIEkyQw0KKwlkZWZhdWx0IG4NCisJaGVscA0KKwkgIFRoaXMgZW5hYmxl cyBzdXBwb3J0IGZvciBTaVMgOTIwMCBmYW1pbHkgb3ZlciBJMkMgYmFzZWQgdG91Y2hzY3JlZW5z Lg0KKw0KKw0KIGVuZGlmDQpkaWZmIC0tZ2l0IGEvbGludXgtMy4xOC4xL2RyaXZlcnMvaW5wdXQv dG91Y2hzY3JlZW4vTWFrZWZpbGUgYi9saW51eC0zLjE4LjEvZHJpdmVycy9pbnB1dC90b3VjaHNj cmVlbi9NYWtlZmlsZQ0KaW5kZXggMDkwZTYxYy4uNjcxMzdhZiAxMDA2NDQNCi0tLSBhL2xpbnV4 LTMuMTguMS9kcml2ZXJzL2lucHV0L3RvdWNoc2NyZWVuL01ha2VmaWxlDQorKysgYi9saW51eC0z LjE4LjEvZHJpdmVycy9pbnB1dC90b3VjaHNjcmVlbi9NYWtlZmlsZQ0KQEAgLTc5LDMgKzc5LDQg QEAgb2JqLSQoQ09ORklHX1RPVUNIU0NSRUVOX1dNOTdYWF9aWUxPTklURSkJKz0genlsb25pdGUt d205N3h4Lm8NCiBvYmotJChDT05GSUdfVE9VQ0hTQ1JFRU5fVzkwWDkwMCkJKz0gdzkwcDkxMF90 cy5vDQogb2JqLSQoQ09ORklHX1RPVUNIU0NSRUVOX1RQUzY1MDdYKQkrPSB0cHM2NTA3eC10cy5v DQogb2JqLSQoQ09ORklHX1RPVUNIU0NSRUVOX1pGT1JDRSkJKz0gemZvcmNlX3RzLm8NCitvYmot JChDT05GSUdfVE9VQ0hTQ1JFRU5fU0lTX0kyQykgICAJKz0gc2lzX2kyYy5vDQpkaWZmIC0tZ2l0 IGEvbGludXgtMy4xOC4xL2RyaXZlcnMvaW5wdXQvdG91Y2hzY3JlZW4vc2lzX2kyYy5jIGIvbGlu dXgtMy4xOC4xL2RyaXZlcnMvaW5wdXQvdG91Y2hzY3JlZW4vc2lzX2kyYy5jDQpuZXcgZmlsZSBt b2RlIDEwMDY0NA0KaW5kZXggMDAwMDAwMC4uMTU3Zjk5MQ0KLS0tIC9kZXYvbnVsbA0KKysrIGIv bGludXgtMy4xOC4xL2RyaXZlcnMvaW5wdXQvdG91Y2hzY3JlZW4vc2lzX2kyYy5jDQpAQCAtMCww ICsxLDEyNjcgQEANCisvKg0KKyAqIFNpUyA5MjAwIGZhbWlseSBJMkMgVG91Y2ggU2NyZWVuIENv bnRyb2xsZXIgRHJpdmVyDQorICoNCisgKiBDb3B5cmlnaHQgKEMpIDIwMTEgU2lTLCBJbmMuDQor ICoNCisgKiBUaGlzIHNvZnR3YXJlIGlzIGxpY2Vuc2VkIHVuZGVyIHRoZSB0ZXJtcyBvZiB0aGUg R05VIEdlbmVyYWwgUHVibGljDQorICogTGljZW5zZSB2ZXJzaW9uIDIsIGFzIHB1Ymxpc2hlZCBi eSB0aGUgRnJlZSBTb2Z0d2FyZSBGb3VuZGF0aW9uLCBhbmQNCisgKiBtYXkgYmUgY29waWVkLCBk aXN0cmlidXRlZCwgYW5kIG1vZGlmaWVkIHVuZGVyIHRob3NlIHRlcm1zLg0KKyAqDQorICogVGhp cyBwcm9ncmFtIGlzIGRpc3RyaWJ1dGVkIGluIHRoZSBob3BlIHRoYXQgaXQgd2lsbCBiZSB1c2Vm dWwsDQorICogYnV0IFdJVEhPVVQgQU5ZIFdBUlJBTlRZOyB3aXRob3V0IGV2ZW4gdGhlIGltcGxp ZWQgd2FycmFudHkgb2YNCisgKiBNRVJDSEFOVEFCSUxJVFkgb3IgRklUTkVTUyBGT1IgQSBQQVJU SUNVTEFSIFBVUlBPU0UuICBTZWUgdGhlDQorICogR05VIEdlbmVyYWwgUHVibGljIExpY2Vuc2Ug Zm9yIG1vcmUgZGV0YWlscy4NCisgKg0KKyAqLw0KKw0KKyNpbmNsdWRlIDxsaW51eC9tb2R1bGUu aD4NCisjaW5jbHVkZSA8bGludXgvZGVsYXkuaD4NCisjaWZkZWYgQ09ORklHX0hBU19FQVJMWVNV U1BFTkQNCisjaW5jbHVkZSA8bGludXgvZWFybHlzdXNwZW5kLmg+DQorI2VuZGlmDQorI2luY2x1 ZGUgPGxpbnV4L2hydGltZXIuaD4NCisjaW5jbHVkZSA8bGludXgvaTJjLmg+DQorI2luY2x1ZGUg PGxpbnV4L2lucHV0Lmg+DQorI2luY2x1ZGUgPGxpbnV4L2ludGVycnVwdC5oPg0KKyNpbmNsdWRl IDxsaW51eC9pby5oPg0KKyNpbmNsdWRlIDxsaW51eC9wbGF0Zm9ybV9kZXZpY2UuaD4NCisjaW5j bHVkZSAic2lzX2kyYy5oIg0KKyNpbmNsdWRlIDxsaW51eC9saW5rYWdlLmg+DQorI2luY2x1ZGUg PGxpbnV4L3NsYWIuaD4NCisjaW5jbHVkZSA8bGludXgvZ3Bpby5oPg0KKyNpbmNsdWRlIDxhc20v dWFjY2Vzcy5oPg0KKyNpbmNsdWRlIDxsaW51eC9pcnEuaD4NCisjaW5jbHVkZSA8YXNtL3VuYWxp Z25lZC5oPg0KKw0KKyNpZmRlZiBfU1REX1JXX0lPDQorI2luY2x1ZGUgPGxpbnV4L2luaXQuaD4N CisjaW5jbHVkZSA8bGludXgvZnMuaD4NCisjaW5jbHVkZSA8bGludXgvY2Rldi5oPg0KKyNkZWZp bmUgREVWSUNFX05BTUUgInNpc19hZWdpc190b3VjaF9kZXZpY2UiDQorc3RhdGljIGludCBzaXNf Y2hhcl9kZXZzX2NvdW50ID0gMTsgICAgICAgIC8qIGRldmljZSBjb3VudCAqLw0KK3N0YXRpYyBp bnQgc2lzX2NoYXJfbWFqb3IgPSAwOw0KK3N0YXRpYyBzdHJ1Y3QgY2RldiBzaXNfY2hhcl9jZGV2 Ow0KK3N0YXRpYyBzdHJ1Y3QgY2xhc3MgKnNpc19jaGFyX2NsYXNzID0gTlVMTDsgI2VuZGlmDQor DQorLyogQWRkcmVzc2VzIHRvIHNjYW4gKi8NCitzdGF0aWMgY29uc3QgdW5zaWduZWQgc2hvcnQg bm9ybWFsX2kyY1tdID0geyBTSVNfU0xBVkVfQUREUiwgDQorSTJDX0NMSUVOVF9FTkQgfTsgc3Rh dGljIHN0cnVjdCB3b3JrcXVldWVfc3RydWN0ICpzaXNfd3E7IHN0cnVjdCANCitzaXNfdHNfZGF0 YSAqdHNfYmFrID0gMDsgc3RydWN0IHNpc1RQX2RyaXZlcl9kYXRhICpUUEluZm8gPSBOVUxMOyAN CitzdGF0aWMgdm9pZCBzaXNfdHBpbmZvX2NsZWFyKHN0cnVjdCBzaXNUUF9kcml2ZXJfZGF0YSAq VFBJbmZvLCBpbnQgDQorbWF4KTsNCisNCisjaWZkZWYgQ09ORklHX0hBU19FQVJMWVNVU1BFTkQN CitzdGF0aWMgdm9pZCBzaXNfdHNfZWFybHlfc3VzcGVuZChzdHJ1Y3QgZWFybHlfc3VzcGVuZCAq aCk7IHN0YXRpYyB2b2lkIA0KK3Npc190c19sYXRlX3Jlc3VtZShzdHJ1Y3QgZWFybHlfc3VzcGVu ZCAqaCk7ICNlbmRpZg0KKw0KKyNpZmRlZiBDT05GSUdfWDg2DQorLyogc3RhdGljIGNvbnN0IHN0 cnVjdCBpMmNfY2xpZW50X2FkZHJlc3NfZGF0YSBhZGRyX2RhdGE7ICovDQorLyogSW5zbW9kIHBh cmFtZXRlcnMgKi8NCitzdGF0aWMgaW50IHNpc190c19kZXRlY3Qoc3RydWN0IGkyY19jbGllbnQg KmNsaWVudCwgc3RydWN0IA0KK2kyY19ib2FyZF9pbmZvICppbmZvKTsgI2VuZGlmDQorDQorI2lm ZGVmIF9DSEVDS19DUkMNCit1aW50MTZfdCBjYWxfY3JjIChjaGFyKiBjbWQsIGludCBzdGFydCwg aW50IGVuZCk7ICNlbmRpZg0KKw0KK3N0YXRpYyB2b2lkIFByaW50QnVmZmVyKGludCBzdGFydCwg aW50IGxlbmd0aCwgY2hhciogYnVmKSB7DQorCWludCBpOw0KKwlmb3IgKCBpID0gc3RhcnQ7IGkg PCBsZW5ndGg7IGkrKyApDQorCXsNCisJCXByaW50aygiJTAyeCAiLCBidWZbaV0pOw0KKwkJaWYg KGkgIT0gMCAmJiBpICUgMzAgPT0gMCkNCisJCQlwcmludGsoIlxuIik7DQorCX0NCisJcHJpbnRr KCJcbiIpOwkNCit9DQorDQoraW50IHNpc19jb21tYW5kX2Zvcl93cml0ZShzdHJ1Y3QgaTJjX2Ns aWVudCAqY2xpZW50LCBpbnQgd2xlbmd0aCwgDQordW5zaWduZWQgY2hhciAqd2RhdGEpIHsNCisg ICAgaW50IHJldCA9IC0xOw0KKyAgICBzdHJ1Y3QgaTJjX21zZyBtc2c7DQorDQorICAgIG1zZy5h ZGRyID0gY2xpZW50LT5hZGRyOw0KKyAgICAvKiBXcml0ZSAqLw0KKyAgICBtc2cuZmxhZ3MgPSAw Ow0KKyAgICBtc2cubGVuID0gd2xlbmd0aDsNCisgICAgbXNnLmJ1ZiA9ICh1bnNpZ25lZCBjaGFy ICopd2RhdGE7DQorDQorICAgIHJldCA9IGkyY190cmFuc2ZlcihjbGllbnQtPmFkYXB0ZXIsICZt c2csIDEpOw0KKw0KKyAgICByZXR1cm4gcmV0Ow0KK30NCisNCitpbnQgc2lzX2NvbW1hbmRfZm9y X3JlYWQoc3RydWN0IGkyY19jbGllbnQgKmNsaWVudCwgaW50IHJsZW5ndGgsIA0KK3Vuc2lnbmVk IGNoYXIgKnJkYXRhKSB7DQorICAgIGludCByZXQgPSAtMTsNCisgICAgc3RydWN0IGkyY19tc2cg bXNnOw0KKw0KKyAgICBtc2cuYWRkciA9IGNsaWVudC0+YWRkcjsNCisgICAgLyogUmVhZCAqLw0K KyAgICBtc2cuZmxhZ3MgPSBJMkNfTV9SRDsNCisgICAgbXNnLmxlbiA9IHJsZW5ndGg7DQorICAg IG1zZy5idWYgPSByZGF0YTsNCisNCisgICAgcmV0ID0gaTJjX3RyYW5zZmVyKGNsaWVudC0+YWRh cHRlciwgJm1zZywgMSk7DQorDQorICAgIHJldHVybiByZXQ7DQorfQ0KKw0KK2ludCBzaXNfY3Vs X3VuaXQodWludDhfdCByZXBvcnRfaWQpDQorew0KKwlpbnQgcmV0ID0gTk9STUFMX0xFTl9QRVJf UE9JTlQ7DQorCQ0KKwlpZiAocmVwb3J0X2lkICE9IEFMTF9JTl9PTkVfUEFDS0FHRSkNCisJew0K KwkJaWYgKElTX0FSRUEocmVwb3J0X2lkKSAvKiYmIElTX1RPVUNIKHJlcG9ydF9pZCkqLykNCisJ CXsNCisJCQlyZXQgKz0gQVJFQV9MRU5fUEVSX1BPSU5UOw0KKwkJfQ0KKwkJaWYgKElTX1BSRVNT VVJFKHJlcG9ydF9pZCkpDQorCQl7DQorCQkJcmV0ICs9IFBSRVNTVVJFX0xFTl9QRVJfUE9JTlQ7 DQorCQl9DQorCX0NCisJDQorCXJldHVybiByZXQ7CQ0KK30NCisNCitpbnQgc2lzX1JlYWRQYWNr ZXQoc3RydWN0IGkyY19jbGllbnQgKmNsaWVudCwgdWludDhfdCBjbWQsIHVpbnQ4X3QqIA0KK2J1 Zikgew0KKwl1aW50OF90IHRtcGJ1ZltNQVhfQllURV0gPSB7MH07DQorI2lmZGVmIF9DSEVDS19D UkMNCisJdWludDE2X3QgYnVmX2NyYyA9IDA7DQorCXVpbnQxNl90IHBhY2thZ2VfY3JjID0gMDsN CisJaW50IGxfcGFja2FnZV9jcmMgPSAwOw0KKwlpbnQgY3JjX2VuZCA9IDA7DQorI2VuZGlmDQor ICAgIGludCByZXQgPSAtMTsNCisgICAgaW50IHRvdWNobnVtID0gMDsNCisgICAgaW50IHBfY291 bnQgPSAwOw0KKyAgICBpbnQgdG91Y19mb3JtYXRlX2lkID0gMDsNCisgICAgaW50IGxvY2F0ZSA9 IDA7DQorICAgIGJvb2wgcmVhZF9maXJzdCA9IHRydWU7DQorICAgIA0KKy8qDQorCQlOZXcgaTJj IGZvcm1hdCANCisJKiBidWZbMF0gPSBMb3cgOCBiaXRzIG9mIGJ5dGUgY291bnQgdmFsdWUNCisJ KiBidWZbMV0gPSBIaWdoIDggYml0cyBvZiBieXRlIGNvdW50ZSB2YWx1ZQ0KKwkqIGJ1ZlsyXSA9 IFJlcG9ydCBJRA0KKwkqIGJ1Zlt0b3VjaCBudW0gKiA2ICsgMiBdID0gVG91Y2ggaW5mb3JtYXRp b25zOyAxIHRvdWNoIHBvaW50IGhhcyA2IGJ5dGVzLCBpdCBjb3VsZCBiZSBub25lIGlmIG5vIHRv dWNoIA0KKwkqIGJ1Zlt0b3VjaCBudW0gKiA2ICsgM10gPSBUb3VjaCBudW1iZXJzDQorCSogDQor CSogT25lIHRvdWNoIHBvaW50IGluZm9ybWF0aW9uIGluY2x1ZGUgNiBieXRlcywgdGhlIG9yZGVy IGlzIA0KKwkqIA0KKwkqIDEuIHN0YXR1cyA9IHRvdWNoIGRvd24gb3IgdG91Y2ggdXANCisJKiAy LiBpZCA9IGZpbmdlciBpZCANCisJKiAzLiB4IGF4aXMgbG93IDggYml0cw0KKwkqIDQuIHggYXhp cyBoaWdoIDggYml0cw0KKwkqIDUuIHkgYXhpcyBsb3cgOCBiaXRzDQorCSogNi4geSBheGlzIGhp Z2ggOCBiaXRzDQorCSoNCisqLw0KKwlkbw0KKwl7DQorCQlpZiAobG9jYXRlID49IFBBQ0tFVF9C VUZGRVJfU0laRSkNCisJCXsNCisJCQlwcmludGsoS0VSTl9FUlIgInNpc19SZWFkUGFja2V0OiBC dWYgT3ZlcmZsb3dcbiIpOw0KKwkJCXJldHVybiAtMTsNCisJCX0NCisJCQ0KKwkJcmV0ID0gc2lz X2NvbW1hbmRfZm9yX3JlYWQoY2xpZW50LCBNQVhfQllURSwgdG1wYnVmKTsNCisNCisjaWZkZWYg X0RFQlVHX1BBQ0tBR0UNCisJCXByaW50ayhLRVJOX0lORk8gImNoYW9iYW4gdGVzdDogQnVmX0Rh dGEgWzB+NjNdIFxuIik7DQorCQlQcmludEJ1ZmZlcigwLCA2NCwgdG1wYnVmKTsJDQorI2VuZGlm CQkJDQorDQorCQlpZihyZXQgPCAwICkNCisJCXsNCisJCQlwcmludGsoS0VSTl9FUlIgInNpc19S ZWFkUGFja2V0OiBpMmMgdHJhbnNmZXIgZXJyb3JcbiIpOw0KKwkJCXJldHVybiByZXQ7DQorCQl9 DQorCQkvKiBlcnJvciBwYWNrYWdlIGxlbmd0aCBvZiByZWNlaXZpbmcgZGF0YSAqLw0KKwkJZWxz ZSBpZiAodG1wYnVmW1BfQllURUNPVU5UXSA+IE1BWF9CWVRFKQ0KKwkJew0KKwkJCXByaW50ayhL RVJOX0VSUiAic2lzX1JlYWRQYWNrZXQ6IEVycm9yIEJ5dGVjb3VudFxuIik7DQorCQkJcmV0dXJu IC0xOwkNCisJCX0NCisJCQ0KKwkJaWYgKHJlYWRfZmlyc3QpDQorCQl7DQorI2lmZGVmIF9TVVBQ T1JUX0JVVFRPTl9UT1VDSA0KKwkJCS8qIGFjY2VzcyBCVVRUT04gVE9VQ0ggZXZlbnQgYW5kIEJV VFRPTiBOTyBUT1VDSCBldmVudCAqLw0KKwkJCWlmICh0bXBidWZbUF9SRVBPUlRfSURdID09ICBC VVRUT05fRk9STUFUKQ0KKwkJCXsNCisJCQkJbWVtY3B5KCZidWZbMF0sICZ0bXBidWZbMF0sIDcp Ow0KKwkJCQlyZXR1cm4gMDsgCS8qIHRvdWNobnVtIGlzIDAgKi8NCisJCQl9DQorI2VuZGlmIA0K KwkJCS8qIGFjY2VzcyBOTyBUT1VDSCBldmVudCB1bmxlc3MgQlVUVE9OIE5PIFRPVUNIIGV2ZW50 ICovDQorCQkJaWYgKHRtcGJ1ZltQX0JZVEVDT1VOVF0gPT0gMC8qTk9fVE9VQ0hfQllURUNPVU5U Ki8pDQorCQkJew0KKwkJCQlyZXR1cm4gMDsJLyogdG91Y2hudW0gaXMgMCAqLw0KKwkJCX0NCisJ CX0NCisNCisJCS8qIHNraXAgcGFyc2luZyBkYXRhIHdoZW4gdHdvIGRldmljZXMgYXJlIHJlZ2lz dGVyZWQgYXQgdGhlIHNhbWUgc2xhdmUgYWRkcmVzcw0KKwkJICogcGFyc2luZyBkYXRhIHdoZW4g UF9SRVBPUlRfSUQgJiYgMHhmIGlzIFRPVUNIX0ZPUk1BVCBvciBQX1JFUE9SVF9JRCBpcyBBTExf SU5fT05FX1BBQ0tBR0UNCisJCSAqLyAgDQorCQl0b3VjX2Zvcm1hdGVfaWQgPSB0bXBidWZbUF9S RVBPUlRfSURdICYgMHhmOw0KKwkJaWYgKCh0b3VjX2Zvcm1hdGVfaWQgIT0gVE9VQ0hfRk9STUFU KSAmJiAodG91Y19mb3JtYXRlX2lkICE9IEhJREkyQ19GT1JNQVQpICYmICh0bXBidWZbUF9SRVBP UlRfSURdICE9IEFMTF9JTl9PTkVfUEFDS0FHRSkpDQorCQl7DQorCQkJcHJpbnRrKEtFUk5fRVJS ICJzaXNfUmVhZFBhY2tldDogRXJyb3IgUmVwb3J0X0lEXG4iKTsNCisJCQlyZXR1cm4gLTE7CQkN CisJCX0NCisJCQ0KKwkJcF9jb3VudCA9IChpbnQpIHRtcGJ1ZltQX0JZVEVDT1VOVF0gLSAxOwkv KiBzdGFydCBmcm9tIDAgKi8NCisJCWlmICh0bXBidWZbUF9SRVBPUlRfSURdICE9IEFMTF9JTl9P TkVfUEFDS0FHRSkNCisJCXsNCisJCQlpZiAoSVNfVE9VQ0godG1wYnVmW1BfUkVQT1JUX0lEXSkp DQorCQkJew0KKwkJCQlwX2NvdW50IC09IEJZVEVfQ1JDX0kyQzsJLyogZGVsZXRlIDIgYnl0ZSBj cmMgKi8NCisJCQl9DQorCQkJZWxzZSBpZiAoSVNfSElESTJDKHRtcGJ1ZltQX1JFUE9SVF9JRF0p KQ0KKwkJCXsNCisJCQkJcF9jb3VudCAtPSBCWVRFX0NSQ19ISURJMkM7DQorCQkJfQ0KKwkJCWVs c2UJLyogc2hvdWxkIG5vdCBiZSBoYXBwZW4gKi8NCisJCQl7DQorCQkJCXByaW50ayhLRVJOX0VS UiAic2lzX1JlYWRQYWNrZXQ6IGRlbGV0ZSBjcmMgZXJyb3JcbiIpOw0KKwkJCQlyZXR1cm4gLTE7 DQorCQkJfQ0KKw0KKwkJCWlmIChJU19TQ0FOVElNRSh0bXBidWZbUF9SRVBPUlRfSURdKSkNCisJ CQl7DQorCQkJCXBfY291bnQgLT0gQllURV9TQ0FOVElNRTsNCisJCQl9DQorCQl9DQorCQkvKiBl bHNlIHt9ICAgIAkJCQkJCSBGb3IgQUxMX0lOX09ORV9QQUNLQUdFICovDQorCQkNCisJCWlmIChy ZWFkX2ZpcnN0KQ0KKwkJew0KKwkJCXRvdWNobnVtID0gdG1wYnVmW3BfY291bnRdOyAJDQorCQl9 DQorCQllbHNlDQorCQl7DQorCQkJaWYgKHRtcGJ1ZltwX2NvdW50XSAhPSAwKQ0KKwkJCXsNCisJ CQkJcHJpbnRrKEtFUk5fRVJSICJzaXNfUmVhZFBhY2tldDogZ2V0IGVycm9yIHBhY2thZ2VcbiIp Ow0KKwkJCQlyZXR1cm4gLTE7DQorCQkJfQ0KKwkJfQ0KKw0KKyNpZmRlZiBfQ0hFQ0tfQ1JDDQor CQljcmNfZW5kID0gcF9jb3VudCArIChJU19TQ0FOVElNRSh0bXBidWZbUF9SRVBPUlRfSURdKSAq IDIpOw0KKwkJYnVmX2NyYyA9IGNhbF9jcmModG1wYnVmLCAyLCBjcmNfZW5kKTsgLyogc3ViIGJ5 dGVjb3VudCAoMiBieXRlKSAqLw0KKwkJbF9wYWNrYWdlX2NyYyA9IHBfY291bnQgKyAxICsgKElT X1NDQU5USU1FKHRtcGJ1ZltQX1JFUE9SVF9JRF0pICogMik7DQorCQlwYWNrYWdlX2NyYyA9IGdl dF91bmFsaWduZWRfbGUxNigmdG1wYnVmW2xfcGFja2FnZV9jcmNdKTsNCisJCQkNCisJCWlmIChi dWZfY3JjICE9IHBhY2thZ2VfY3JjKQ0KKwkJew0KKwkJCXByaW50ayhLRVJOX0VSUiAic2lzX1Jl YWRQYWNrZXQ6IENSQyBFcnJvclxuIik7DQorCQkJcmV0dXJuIC0xOw0KKwkJfQ0KKyNlbmRpZgkN CisJCW1lbWNweSgmYnVmW2xvY2F0ZV0sICZ0bXBidWZbMF0sIDY0KTsJLyogQnVmX0RhdGEgWzB+ NjNdIFs2NH4xMjhdICovDQorCQlsb2NhdGUgKz0gNjQ7DQorCQlyZWFkX2ZpcnN0ID0gZmFsc2U7 DQorCQkNCisJfXdoaWxlKHRtcGJ1ZltQX1JFUE9SVF9JRF0gIT0gQUxMX0lOX09ORV9QQUNLQUdF ICAmJiAgdG1wYnVmW3BfY291bnRdIA0KKz4gNSk7DQorDQorCXJldHVybiB0b3VjaG51bTsNCit9 CQ0KKw0KKw0KK2ludCBjaGVja19ncGlvX2ludGVycnVwdCh2b2lkKQ0KK3sNCisgICAgaW50IHJl dCA9IDA7DQorDQorICAgIC8qIENIRUNLIEdQSU8gSU5URVJSVVBUIFNUQVRVUyBCWSBZT1VSIFBM QVRGT1JNIFNFVFRJTkcuICovDQorICAgIHJldCA9IGdwaW9fZ2V0X3ZhbHVlKEdQSU9fSVJRKTsN CisJDQorICAgIHJldHVybiByZXQ7DQorfQ0KKw0KK3ZvaWQgdHNfcmVwb3J0X2tleShzdHJ1Y3Qg aTJjX2NsaWVudCAqY2xpZW50LCB1aW50OF90IGtleWJpdF9zdGF0ZSkgew0KKwlpbnQgaSA9IDA7 DQorCXVpbnQ4X3QgZGlmZl9rZXliaXRfc3RhdGU9IDB4MDsgLyogY2hlY2sga2V5Yml0X3N0YXRl IGlzIGRpZmZlcmVuY2Ugd2l0aCBwcmVfa2V5Yml0X3N0YXRlICovDQorCXVpbnQ4X3Qga2V5X3Zh bHVlID0gMHgwOyAJCS8qIGJ1dHRvbiBsb2NhdGlvbiBmb3IgYmluYXJ5ICovDQorCXVpbnQ4X3Qg IGtleV9wcmVzc2VkID0gMHgwOyAJLyogYnV0dG9uIGlzIHVwIG9yIGRvd24gKi8NCisJc3RydWN0 IHNpc190c19kYXRhICp0cyA9IGkyY19nZXRfY2xpZW50ZGF0YShjbGllbnQpOw0KKw0KKwlpZiAo IXRzKQ0KKwl7DQorCQlwcmludGsoS0VSTl9FUlIgIiVzIGVycm9yOiBNaXNzaW5nIFBsYXRmb3Jt IERhdGEhXG4iLCBfX2Z1bmNfXyk7DQorCQlyZXR1cm47DQorCX0NCisNCisJZGlmZl9rZXliaXRf c3RhdGUgPSBUUEluZm8tPnByZV9rZXliaXRfc3RhdGUgXiBrZXliaXRfc3RhdGU7DQorDQorCWlm IChkaWZmX2tleWJpdF9zdGF0ZSkNCisJew0KKwkJZm9yIChpID0gMDsgaSA8IEJVVFRPTl9LRVlf Q09VTlQ7IGkrKykNCisJCXsNCisJCSAgICBpZiAoKGRpZmZfa2V5Yml0X3N0YXRlID4+IGkpICYg MHgwMSkNCisJCQl7DQorCQkJCWtleV92YWx1ZSA9IGRpZmZfa2V5Yml0X3N0YXRlICYgKDB4MDEg PDwgaSk7DQorCQkJCWtleV9wcmVzc2VkID0gKGtleWJpdF9zdGF0ZSA+PiBpKSAmIDB4MDE7DQor CQkJCXN3aXRjaCAoa2V5X3ZhbHVlKQ0KKwkJCQl7DQorCQkJCQljYXNlIE1TS19DT01QOg0KKwkJ CQkJCWlucHV0X3JlcG9ydF9rZXkodHMtPmlucHV0X2RldiwgS0VZX0NPTVBPU0UsIGtleV9wcmVz c2VkKTsNCisJCQkJCQlicmVhazsNCisJCQkJCWNhc2UgTVNLX0JBQ0s6DQorCQkJCQkJaW5wdXRf cmVwb3J0X2tleSh0cy0+aW5wdXRfZGV2LCBLRVlfQkFDSywga2V5X3ByZXNzZWQpOw0KKwkJCQkJ CWJyZWFrOw0KKwkJCQkJY2FzZSBNU0tfTUVOVToNCisJCQkJCQlpbnB1dF9yZXBvcnRfa2V5KHRz LT5pbnB1dF9kZXYsIEtFWV9NRU5VLCBrZXlfcHJlc3NlZCk7DQorCQkJCQkJYnJlYWs7DQorCQkJ CQljYXNlIE1TS19IT01FOg0KKwkJCQkJCWlucHV0X3JlcG9ydF9rZXkodHMtPmlucHV0X2Rldiwg S0VZX0hPTUUsIGtleV9wcmVzc2VkKTsNCisJCQkJCQlicmVhazsNCisJCQkJCWNhc2UgTVNLX05P QlROOg0KKwkJCQkJCS8qIFJlbGVhc2UgdGhlIGJ1dHRvbiBpZiBpdCB0b3VjaGVkLiAqLw0KKwkJ CQkJZGVmYXVsdDoNCisJCQkJCQlicmVhazsNCisJCQkJfQ0KKwkJCX0NCisJCX0NCisJCVRQSW5m by0+cHJlX2tleWJpdF9zdGF0ZSA9IGtleWJpdF9zdGF0ZTsNCisJfQ0KK30NCisNCisNCitzdGF0 aWMgdm9pZCBzaXNfdHNfd29ya19mdW5jKHN0cnVjdCB3b3JrX3N0cnVjdCAqd29yaykgew0KKwlz dHJ1Y3Qgc2lzX3RzX2RhdGEgKnRzID0gY29udGFpbmVyX29mKHdvcmssIHN0cnVjdCBzaXNfdHNf ZGF0YSwgd29yayk7DQorICAgIGludCByZXQgPSAtMTsNCisgICAgaW50IHBvaW50X3VuaXQ7ICAN CisJdWludDhfdCBidWZbUEFDS0VUX0JVRkZFUl9TSVpFXSA9IHswfTsNCisJdWludDhfdCBpID0g MCwgZmluZ2VycyA9IDA7DQorCXVpbnQ4X3QgcHggPSAwLCBweSA9IDAsIHBzdGF0dXMgPSAwOw0K Kwl1aW50OF90IHBfYXJlYSA9IDA7DQorICAgIHVpbnQ4X3QgcF9wcmVhc3VyZSA9IDA7DQorI2lm ZGVmIF9TVVBQT1JUX0JVVFRPTl9UT1VDSAkNCisJaW50IGJ1dHRvbl9rZXk7DQorCXVpbnQ4X3Qg YnV0dG9uX2J1ZlsxMF0gPSB7MH07DQorI2VuZGlmDQorDQorI2lmZGVmIF9BTkRST0lEXzQNCisJ Ym9vbCBhbGxfdG91Y2hfdXAgPSB0cnVlOw0KKyNlbmRpZg0KKwkNCisJbXV0ZXhfbG9jaygmdHMt Pm11dGV4X3dxKTsNCisNCisgICAgLyogSTJDIG9yIFNNQlVTIGJsb2NrIGRhdGEgcmVhZCAqLw0K KyAgICByZXQgPSBzaXNfUmVhZFBhY2tldCh0cy0+Y2xpZW50LCBTSVNfQ01EX05PUk1BTCwgYnVm KTsNCisgDQorI2lmZGVmIF9TVVBQT1JUX0JVVFRPTl9UT1VDSA0KKwkgc2lzX1JlYWRQYWNrZXQo dHMtPmNsaWVudCwgU0lTX0NNRF9OT1JNQUwsIGJ1dHRvbl9idWYpOyAjZW5kaWYNCisNCisJLyog RXJyb3IgTnVtYmVyICovDQorCWlmIChyZXQgPCAwKSANCisJew0KKwkJZ290byBlcnJfZnJlZV9h bGxvY2F0ZTsNCisJfQ0KKyNpZmRlZiBfU1VQUE9SVF9CVVRUT05fVE9VQ0gNCisJLyogYWNjZXNz IEJVVFRPTiBUT1VDSCBldmVudCBhbmQgQlVUVE9OIE5PIFRPVUNIIGV2ZW4gKi8NCisJZWxzZSBp ZiAoYnV0dG9uX2J1ZltQX1JFUE9SVF9JRF0gPT0gQlVUVE9OX0ZPUk1BVCkNCisJew0KKwkJYnV0 dG9uX2tleSA9IGdldF91bmFsaWduZWRfbGUxNigmYnV0dG9uX2J1ZltCVVRUT05fU1RBVEVdKTsJ CQ0KKwkJdHNfcmVwb3J0X2tleSh0cy0+Y2xpZW50LCBidXR0b25fa2V5KTsNCisJfQ0KKyNlbmRp Zg0KKwkvKiBhY2Nlc3MgTk8gVE9VQ0ggZXZlbnQgdW5sZXNzIEJVVFRPTiBOTyBUT1VDSCBldmVu dCAqLw0KKwllbHNlIGlmIChyZXQgPT0gMCkNCisJew0KKwkJZmluZ2VycyA9IDA7DQorCQlzaXNf dHBpbmZvX2NsZWFyKFRQSW5mbywgTUFYX0ZJTkdFUlMpOw0KKwkJZ290byBsYWJlbF9zZW5kX3Jl cG9ydDsgIC8qIG5lZWQgdG8gcmVwb3J0IGlucHV0X210X3N5bmMoKSAqLw0KKwl9DQorCQ0KKwlz aXNfdHBpbmZvX2NsZWFyKFRQSW5mbywgTUFYX0ZJTkdFUlMpOw0KKwkNCisJLyogUGFyc2VyIGFu ZCBHZXQgdGhlIHNpczkyMDAgZGF0YSAqLw0KKwlwb2ludF91bml0ID0gc2lzX2N1bF91bml0KGJ1 ZltQX1JFUE9SVF9JRF0pOw0KKwlmaW5nZXJzID0gcmV0Ow0KKwkNCisJVFBJbmZvLT5maW5nZXJz ID0gZmluZ2VycyA9IChmaW5nZXJzID4gTUFYX0ZJTkdFUlMgPyAwIDogZmluZ2Vycyk7DQorCQ0K KwkvKiBmaW5nZXJzIDEwID0gIDAgfiA5ICovDQorCWZvciAoaSA9IDA7IGkgPCBmaW5nZXJzOyBp KyspIA0KKwl7DQorICAgICAgICBpZiAoKGJ1ZltQX1JFUE9SVF9JRF0gIT0gQUxMX0lOX09ORV9Q QUNLQUdFKSAmJiAoaSA+PSA1KSkNCisgICAgICAgIHsgLyogQ2FsYyBwb2ludCBzdGF0dXMgKi8N CisJCQlwc3RhdHVzID0gQllURV9CWVRFQ09VTlQgKyBCWVRFX1JlcG9ydElEICsgKChpIC0gNSkg KiBwb2ludF91bml0KTsgICAgCQ0KKwkJCXBzdGF0dXMgKz0gNjQ7DQorCQl9DQorCQllbHNlIA0K KwkJeyAvKiBDYWxjIHBvaW50IHN0YXR1cyAqLw0KKwkJCXBzdGF0dXMgPSBCWVRFX0JZVEVDT1VO VCArIEJZVEVfUmVwb3J0SUQgKyAoaSAqIHBvaW50X3VuaXQpOyAgICAgICAgICAJDQorCQl9DQor DQorCSAgICBweCA9IHBzdGF0dXMgKyAyOwkvKiBDYWxjIHBvaW50IHhfY29vcmQgKi8NCisJICAg IHB5ID0gcHggKyAyOwkJLyogQ2FsYyBwb2ludCB5X2Nvb3JkICovDQorDQorCQlpZiAoKGJ1Zltw c3RhdHVzXSkgPT0gVE9VQ0hVUCkNCisJCXsNCisJCQlUUEluZm8tPnB0W2ldLldpZHRoID0gMDsN CisJCQlUUEluZm8tPnB0W2ldLkhlaWdodCA9IDA7DQorCQkJVFBJbmZvLT5wdFtpXS5QcmVzc3Vy ZSA9IDA7DQorCQl9DQorCQllbHNlIGlmIChidWZbUF9SRVBPUlRfSURdID09IEFMTF9JTl9PTkVf UEFDS0FHRSAmJiAoYnVmW3BzdGF0dXNdKSA9PSBUT1VDSERPV04pDQorCQl7DQorCQkJVFBJbmZv LT5wdFtpXS5XaWR0aCA9IDE7DQorCQkJVFBJbmZvLT5wdFtpXS5IZWlnaHQgPSAxOw0KKwkJCVRQ SW5mby0+cHRbaV0uUHJlc3N1cmUgPSAxOwkJCQ0KKwkJfQ0KKwkJZWxzZSBpZiAoKGJ1Zltwc3Rh dHVzXSkgPT0gVE9VQ0hET1dOKQ0KKwkJewkNCisJCQlwX2FyZWEgPSBweSArIDI7DQorCQkJcF9w cmVhc3VyZSA9IHB5ICsgMiArIChJU19BUkVBKGJ1ZltQX1JFUE9SVF9JRF0pICogMik7DQorDQor CQkJLyogYXJlYSAqLw0KKwkJCWlmIChJU19BUkVBKGJ1ZltQX1JFUE9SVF9JRF0pKQ0KKwkJCXsN CisJCQkJVFBJbmZvLT5wdFtpXS5XaWR0aCA9IGJ1ZltwX2FyZWFdICYgMHhmZjsNCisJCQkJVFBJ bmZvLT5wdFtpXS5IZWlnaHQgPSBidWZbcF9hcmVhICsgMV0gJiAweGZmOw0KKwkJCX0NCisJCQll bHNlIA0KKwkJCXsNCisJCQkJVFBJbmZvLT5wdFtpXS5XaWR0aCA9IDE7DQorCQkJCVRQSW5mby0+ cHRbaV0uSGVpZ2h0ID0gMTsNCisJCQl9DQorCQkJLyogcHJlYXN1cmUgKi8NCisJCQlpZiAoSVNf UFJFU1NVUkUoYnVmW1BfUkVQT1JUX0lEXSkpDQorCQkJCVRQSW5mby0+cHRbaV0uUHJlc3N1cmUg PSAoYnVmW3BfcHJlYXN1cmVdKTsNCisJCQllbHNlIA0KKwkJCQlUUEluZm8tPnB0W2ldLlByZXNz dXJlID0gMTsJCQkJDQorCQl9DQorCQllbHNlDQorCQl7DQorCQkJcHJpbnRrKEtFUk5fRVJSICJz aXNfdHNfd29ya19mdW5jOiBFcnJvciBUb3VjaCBTdGF0dXNcbiIpOw0KKwkJCWdvdG8gZXJyX2Zy ZWVfYWxsb2NhdGU7DQorCQl9DQorCQkNCisJCVRQSW5mby0+cHRbaV0uaWQgPSAoYnVmW3BzdGF0 dXMgKyAxXSk7DQorCQlUUEluZm8tPnB0W2ldLnggPSAoKGJ1ZltweF0gJiAweGZmKSB8ICgoYnVm W3B4ICsgMV0gJiAweGZmKTw8IDgpKTsNCisgICAgICAgIFRQSW5mby0+cHRbaV0ueSA9ICgoYnVm W3B5XSAmIDB4ZmYpIHwgKChidWZbcHkgKyAxXSAmIDB4ZmYpPDwgOCkpOyAgICAgIA0KKwl9DQor CQkNCisjaWZkZWYgX0RFQlVHX1JFUE9SVA0KKwlmb3IgKGkgPSAwOyBpIDwgVFBJbmZvLT5maW5n ZXJzOyBpKyspDQorCXsNCisJCSBwcmludGsoS0VSTl9JTkZPICJjaGFvYmFuIHRlc3Q6IGkgPSAl ZCwgaWQgPSAlZCwgeCA9ICVkLCB5ID0gJWQsIHBzdGF0dXMgPSAlZCwgd2lkdGggPSAlZCwgaGVp Z2h0ID0gJWQsIHByZXNzdXJlID0gJWQsIFxuIiwgaSwgVFBJbmZvLT5wdFtpXS5pZCwgVFBJbmZv LT5wdFtpXS54LCBUUEluZm8tPnB0W2ldLnksIGJ1Zltwc3RhdHVzXSwgVFBJbmZvLT5wdFtpXS5X aWR0aCwgIFRQSW5mby0+cHRbaV0uSGVpZ2h0LCBUUEluZm8tPnB0W2ldLlByZXNzdXJlKTsNCisJ fQ0KKyNlbmRpZg0KKw0KK2xhYmVsX3NlbmRfcmVwb3J0Og0KKy8qIFJlcG9ydCBjby1vcmRpbmF0 ZXMgdG8gdGhlIG11bHRpLXRvdWNoIHN0YWNrICovDQorI2lmZGVmIF9BTkRST0lEXzQJDQorCWZv cihpID0gMDsgKChpIDwgVFBJbmZvLT5maW5nZXJzKSAmJiAoaSA8IE1BWF9GSU5HRVJTKSk7IGkr KykNCisJew0KKwkJaWYoVFBJbmZvLT5wdFtpXS5QcmVzc3VyZSkNCisJCXsNCisJCQlUUEluZm8t PnB0W2ldLldpZHRoICo9IEFSRUFfVU5JVDsJDQorCQkJaW5wdXRfcmVwb3J0X2Ficyh0cy0+aW5w dXRfZGV2LCBBQlNfTVRfVE9VQ0hfTUFKT1IsIFRQSW5mby0+cHRbaV0uV2lkdGgpOw0KKwkJCVRQ SW5mby0+cHRbaV0uSGVpZ2h0ICo9IEFSRUFfVU5JVDsNCisJCQlpbnB1dF9yZXBvcnRfYWJzKHRz LT5pbnB1dF9kZXYsIEFCU19NVF9UT1VDSF9NSU5PUiwgVFBJbmZvLT5wdFtpXS5IZWlnaHQpOwkJ CQ0KKwkJCWlucHV0X3JlcG9ydF9hYnModHMtPmlucHV0X2RldiwgQUJTX01UX1BSRVNTVVJFLCBU UEluZm8tPnB0W2ldLlByZXNzdXJlKTsNCisJCQlpbnB1dF9yZXBvcnRfYWJzKHRzLT5pbnB1dF9k ZXYsIEFCU19NVF9QT1NJVElPTl9YLCBUUEluZm8tPnB0W2ldLngpOw0KKwkJCWlucHV0X3JlcG9y dF9hYnModHMtPmlucHV0X2RldiwgQUJTX01UX1BPU0lUSU9OX1ksIFRQSW5mby0+cHRbaV0ueSk7 DQorCQkJaW5wdXRfcmVwb3J0X2Ficyh0cy0+aW5wdXRfZGV2LCBBQlNfTVRfVFJBQ0tJTkdfSUQs IFRQSW5mby0+cHRbaV0uaWQpOw0KKwkJCWlucHV0X210X3N5bmModHMtPmlucHV0X2Rldik7DQor CQkJYWxsX3RvdWNoX3VwID0gZmFsc2U7DQorCQl9DQorCQkNCisJCWlmIChpID09IChUUEluZm8t PmZpbmdlcnMgLTEpICYmIGFsbF90b3VjaF91cCA9PSB0cnVlKQ0KKwkJew0KKwkJCWlucHV0X210 X3N5bmModHMtPmlucHV0X2Rldik7DQorCQl9DQorCX0NCisNCisJaWYoVFBJbmZvLT5maW5nZXJz ID09IDApDQorCXsNCisJCWlucHV0X210X3N5bmModHMtPmlucHV0X2Rldik7DQorCX0NCisjZWxz ZQ0KKwlpID0gMDsNCisJZG8NCisJew0KKwkJaW5wdXRfcmVwb3J0X2Ficyh0cy0+aW5wdXRfZGV2 LCBBQlNfTVRfVE9VQ0hfTUFKT1IsIFRQSW5mby0+cHRbaV0uUHJlc3N1cmUpOw0KKwkJaW5wdXRf cmVwb3J0X2Ficyh0cy0+aW5wdXRfZGV2LCBBQlNfTVRfV0lEVEhfTUFKT1IsIFRQSW5mby0+cHRb aV0uV2lkdGgpOw0KKwkJaW5wdXRfcmVwb3J0X2Ficyh0cy0+aW5wdXRfZGV2LCBBQlNfTVRfV0lE VEhfTUlOT1IsIFRQSW5mby0+cHRbaV0uSGVpZ2h0KTsNCisJCWlucHV0X3JlcG9ydF9hYnModHMt PmlucHV0X2RldiwgQUJTX01UX1BPU0lUSU9OX1gsIFRQSW5mby0+cHRbaV0ueCk7DQorCQlpbnB1 dF9yZXBvcnRfYWJzKHRzLT5pbnB1dF9kZXYsIEFCU19NVF9QT1NJVElPTl9ZLCBUUEluZm8tPnB0 W2ldLnkpOw0KKwkJaW5wdXRfcmVwb3J0X2Ficyh0cy0+aW5wdXRfZGV2LCBBQlNfTVRfVFJBQ0tJ TkdfSUQsIFRQSW5mby0+cHRbaV0uaWQpOyAvKiBBbmRyb2lkIDIuMyAqLw0KKwkJaW5wdXRfbXRf c3luYyh0cy0+aW5wdXRfZGV2KTsNCisJCWkrKzsNCisJfQ0KKwl3aGlsZSAoKGkgPCBUUEluZm8t PmZpbmdlcnMpICYmIChpIDwgTUFYX0ZJTkdFUlMpKTsgI2VuZGlmDQorCWlucHV0X3N5bmModHMt PmlucHV0X2Rldik7DQorDQorZXJyX2ZyZWVfYWxsb2NhdGU6DQorDQorICAgIGlmICh0cy0+dXNl X2lycSkNCisgICAgew0KKy8qIGNhc2UgMSBtb2RlICovDQorI2lmZGVmIF9JTlRfTU9ERV8xIA0K KwkgICAgLypUT0RPOiBBZnRlciBpbnRlcnJ1cHQgc3RhdHVzIGxvdywgcmVhZCBpMmMgYnVzIGRh dGEgYnkgcG9sbGluZywgdW50aWwgaW50ZXJydXB0IHN0YXR1cyBpcyBoaWdoICovDQorCSAgICBy ZXQgPSBjaGVja19ncGlvX2ludGVycnVwdCgpOwkvKiBpbnRlcnJ1cHQgcGluIGlzIHN0aWxsIExP VywgcmVhZCBkYXRhIHVudGlsIGludGVycnVwdCBwaW4gaXMgcmVsZWFzZWQuICovDQorCSAgICBp ZiAoIXJldCkNCisJICAgIHsNCisJICAgICAgICBocnRpbWVyX3N0YXJ0KCZ0cy0+dGltZXIsIGt0 aW1lX3NldCgwLCBUSU1FUl9OUyksIEhSVElNRVJfTU9ERV9SRUwpOw0KKwkgICAgfQ0KKwkgICAg ZWxzZQ0KKwkgICAgew0KKwkJCWlmIChUUEluZm8tPnByZV9rZXliaXRfc3RhdGUpDQorCQkJew0K KwkJCQl0c19yZXBvcnRfa2V5KHRzLT5jbGllbnQsIDB4MCk7CS8qIGNsZWFyIGZvciBpbnRlcnJ1 cHQgKi8NCisJCQl9DQorCQkJDQorI2lmICggTElOVVhfVkVSU0lPTl9DT0RFIDwgS0VSTkVMX1ZF UlNJT04gKDIsIDYsIDM5KSApDQorICAgICAgICAJaWYgKCh0cy0+ZGVzYy0+c3RhdHVzICYgSVJR X0RJU0FCTEVEKSA9PSBJUlFfU1RBVFVTX0RJU0FCTEVEKSANCisjZWxzZQ0KKyAgICAgICAgCWlm ICgodHMtPmRlc2MtPmlycV9kYXRhLnN0YXRlX3VzZV9hY2Nlc3NvcnMgJiANCitJUlFEX0lSUV9E SVNBQkxFRCkgPT0gSVJRX1NUQVRVU19ESVNBQkxFRCkgI2VuZGlmDQorICAgICAgICAJew0KKwkJ CQllbmFibGVfaXJxKHRzLT5jbGllbnQtPmlycSk7DQorCQkJfQ0KKwkgICAgfQ0KKy8qIGNhc2Ug MiBtb2RlICovDQorI2Vsc2UNCisNCisjaWYgKCBMSU5VWF9WRVJTSU9OX0NPREUgPCBLRVJORUxf VkVSU0lPTiAoMiwgNiwgMzkpICkNCisJCWlmICgodHMtPmRlc2MtPnN0YXR1cyAmIElSUV9ESVNB QkxFRCkgPT0gSVJRX1NUQVRVU19ESVNBQkxFRCkgI2Vsc2UNCisJCWlmICgodHMtPmRlc2MtPmly cV9kYXRhLnN0YXRlX3VzZV9hY2Nlc3NvcnMgJiBJUlFEX0lSUV9ESVNBQkxFRCkgPT0gDQorSVJR X1NUQVRVU19ESVNBQkxFRCkgI2VuZGlmDQorCQl7DQorCQkJZW5hYmxlX2lycSh0cy0+Y2xpZW50 LT5pcnEpOw0KKwkJfQ0KKyNlbmRpZg0KKwl9DQorDQorCW11dGV4X3VubG9jaygmdHMtPm11dGV4 X3dxKTsNCisgICAgcmV0dXJuOw0KK30NCisNCitzdGF0aWMgdm9pZCBzaXNfdHBpbmZvX2NsZWFy KHN0cnVjdCBzaXNUUF9kcml2ZXJfZGF0YSAqVFBJbmZvLCBpbnQgbWF4KSANCit7DQorCWludCBp ID0gMDsNCisJZm9yKGkgPSAwOyBpIDwgbWF4OyBpKyspDQorCXsNCisJCVRQSW5mby0+cHRbaV0u aWQgPSAtMTsNCisJCVRQSW5mby0+cHRbaV0ueCA9IDA7DQorCQlUUEluZm8tPnB0W2ldLnkgPSAw Ow0KKwkJVFBJbmZvLT5wdFtpXS5QcmVzc3VyZSA9IDA7DQorCQlUUEluZm8tPnB0W2ldLldpZHRo ID0gMDsNCisJfQ0KKwlUUEluZm8tPmlkID0gMHgwOw0KKwlUUEluZm8tPmZpbmdlcnMgPSAwOw0K K30NCisNCitzdGF0aWMgZW51bSBocnRpbWVyX3Jlc3RhcnQgc2lzX3RzX3RpbWVyX2Z1bmMoc3Ry dWN0IGhydGltZXIgKnRpbWVyKSB7DQorCXN0cnVjdCBzaXNfdHNfZGF0YSAqdHMgPSBjb250YWlu ZXJfb2YodGltZXIsIHN0cnVjdCBzaXNfdHNfZGF0YSwgdGltZXIpOw0KKwlxdWV1ZV93b3JrKHNp c193cSwgJnRzLT53b3JrKTsNCisJaWYgKCF0cy0+dXNlX2lycSkNCisJewkvKiBGb3IgUG9sbGlu ZyBtb2RlICovDQorCSAgICBocnRpbWVyX3N0YXJ0KCZ0cy0+dGltZXIsIGt0aW1lX3NldCgwLCBU SU1FUl9OUyksIEhSVElNRVJfTU9ERV9SRUwpOw0KKwl9DQorCXJldHVybiBIUlRJTUVSX05PUkVT VEFSVDsNCit9DQorDQorc3RhdGljIGlycXJldHVybl90IHNpc190c19pcnFfaGFuZGxlcihpbnQg aXJxLCB2b2lkICpkZXZfaWQpIHsNCisJc3RydWN0IHNpc190c19kYXRhICp0cyA9IGRldl9pZDsN CisJDQorI2lmICggTElOVVhfVkVSU0lPTl9DT0RFIDwgS0VSTkVMX1ZFUlNJT04gKDIsIDYsIDM5 KSApDQorCWlmICgodHMtPmRlc2MtPnN0YXR1cyAmIElSUV9ESVNBQkxFRCkgPT0gSVJRX1NUQVRV U19FTkFCTEVEKSAjZWxzZQ0KKwlpZiAoKHRzLT5kZXNjLT5pcnFfZGF0YS5zdGF0ZV91c2VfYWNj ZXNzb3JzICYgSVJRRF9JUlFfRElTQUJMRUQpID09IA0KK0lSUV9TVEFUVVNfRU5BQkxFRCkgI2Vu ZGlmDQorCXsNCisJCWRpc2FibGVfaXJxX25vc3luYyh0cy0+Y2xpZW50LT5pcnEpOw0KKwl9DQor CXF1ZXVlX3dvcmsoc2lzX3dxLCAmdHMtPndvcmspOw0KKwkJDQorCXJldHVybiBJUlFfSEFORExF RDsNCit9DQorDQorc3RhdGljIGludCBpbml0aWFsX2lycSh2b2lkKQ0KK3sNCisJaW50IHJldCA9 IDA7DQorI2lmZGVmIF9JMkNfSU5UX0VOQUJMRQ0KKwkvKiBpbml0aWFsaXplIGdwaW8gYW5kIGlu dGVycnVwdCBwaW5zICovDQorCXJldCA9IGdwaW9fcmVxdWVzdChHUElPX0lSUSwgIkdQSU9fMTMz Iik7CS8qIGV4LiBHUElPXzEzMyBmb3IgaW50ZXJydXB0IG1vZGUgKi8NCisJaWYgKHJldCA8IDAp DQorCXsNCisJCS8qIFNldCBBY3RpdmUgTG93LiBQbGVhc2UgcmVmZXJlbmNlIHRoZSBmaWxlIGlu Y2x1ZGUvbGludXgvaW50ZXJydXB0LmggKi8NCisJfQ0KKwkvKiBzZXR0aW5nIGdwaW8gZGlyZWN0 aW9uIGhlcmUgT1IgYm9hcmRpbmZvIGZpbGUqLw0KKw0KKyNlbHNlDQorCXJldCA9IC0xOw0KKyNl bmRpZg0KKwlyZXR1cm4gcmV0Ow0KK30NCisNCit1aW50MTZfdCBjYWxfY3JjIChjaGFyKiBjbWQs IGludCBzdGFydCwgaW50IGVuZCkgew0KKwlpbnQgaSA9IDA7DQorCXVpbnQxNl90IGNyYyA9IDA7 DQorCQ0KKwlmb3IgKGkgPSBzdGFydDsgaSA8PSBlbmQgOyBpKyspDQorCXsNCisJCWNyYyA9IChj cmM8PDgpIF4gY3JjMTZ0YWJbKChjcmM+PjgpIF4gY21kW2ldICkmMHgwMEZGXTsNCisJfQ0KKwkN CisJcmV0dXJuIGNyYzsNCit9DQorDQordWludDE2X3QgY2FsX2NyY193aXRoX2NtZCAoY2hhciog ZGF0YSwgaW50IHN0YXJ0LCBpbnQgZW5kLCB1aW50OF90IGNtZCkgDQorew0KKwlpbnQgaSA9IDA7 DQorCXVpbnQxNl90IGNyYyA9IDA7DQorCQ0KKwljcmMgPSAoY3JjPDw4KSBeIGNyYzE2dGFiWygo Y3JjPj44KSBeIGNtZCkmMHgwMEZGXTsNCisJZm9yIChpID0gc3RhcnQ7IGkgPD0gZW5kIDsgaSsr KQ0KKwl7DQorCQljcmMgPSAoY3JjPDw4KSBeIGNyYzE2dGFiWygoY3JjPj44KSBeIGRhdGFbaV0g KSYweDAwRkZdOw0KKwl9DQorCQ0KKwlyZXR1cm4gY3JjOw0KK30NCisNCit2b2lkIHdyaXRlX2Ny YyAodW5zaWduZWQgY2hhciAqYnVmLCBpbnQgc3RhcnQsIGludCBlbmQpIHsNCisJdWludDE2X3Qg Y3JjID0gMDsNCisJDQorCWNyYyA9IGNhbF9jcmMgKGJ1Ziwgc3RhcnQgLCBlbmQpOw0KKwlidWZb ZW5kKzFdID0gKGNyYyA+PiA4KSYgMHhmZjsNCisJYnVmW2VuZCsyXSA9IGNyYyAmIDB4ZmY7DQor fQ0KKw0KKyNpZmRlZiBfU1REX1JXX0lPDQorI2RlZmluZSBCVUZGRVJfU0laRSBNQVhfQllURQ0K K3N0YXRpYyBzc2l6ZV90IHNpc19jZGV2X3dyaXRlKCBzdHJ1Y3QgZmlsZSAqZmlsZSwgY29uc3Qg Y2hhciBfX3VzZXIgDQorKmJ1Ziwgc2l6ZV90IGNvdW50LCBsb2ZmX3QgKmZfcG9zICkgew0KKwkg aW50IHJldCA9IDA7DQorCSBjaGFyICprZGF0YTsNCisJIGNoYXIgY21kOw0KKwkgDQorCSBwcmlu dGsoS0VSTl9JTkZPICJzaXNfY2Rldl93cml0ZS5cbiIpOw0KKwkgDQorCSBpZiAodHNfYmFrID09 IDApDQorICAgIAlyZXR1cm4gLTEzOw0KKyAgICAJDQorICAgIHJldCA9IGFjY2Vzc19vayhWRVJJ RllfV1JJVEUsIGJ1ZiwgQlVGRkVSX1NJWkUpOw0KKyAgICBpZiAoIXJldCkgew0KKyAgICAgICAg cHJpbnRrKEtFUk5fRVJSICJjYW5ub3QgYWNjZXNzIHVzZXIgc3BhY2UgbWVtb3J5XG4iKTsNCisg ICAgICAgIHJldHVybiAtMTE7DQorICAgIH0NCisNCisJIGtkYXRhID0ga21hbGxvYyhCVUZGRVJf U0laRSwgR0ZQX0tFUk5FTCk7DQorICAgICBpZiAoa2RhdGEgPT0gMCkNCisgICAgCXJldHVybiAt MTI7DQorICAgIAkNCisgICAgIHJldCA9IGNvcHlfZnJvbV91c2VyKGtkYXRhLCBidWYsIEJVRkZF Ul9TSVpFKTsNCisgICAgIGlmIChyZXQpIHsNCisgICAgICAgIHByaW50ayhLRVJOX0VSUiAiY29w eV9mcm9tX3VzZXIgZmFpbFxuIik7DQorICAgICAgICBrZnJlZShrZGF0YSk7DQorICAgICAgICBy ZXR1cm4gLTE0Ow0KKyAgICAgfQ0KKyNpZiAwDQorCVByaW50QnVmZmVyKDAsIGNvdW50LCBrZGF0 YSk7DQorI2VuZGlmDQorCQkNCisJY21kID0ga2RhdGFbNl07DQorDQorLyogV3JpdGUgJiBSZWFk ICovDQorICAgIHJldCA9IHNpc19jb21tYW5kX2Zvcl93cml0ZSh0c19iYWstPmNsaWVudCwgY291 bnQsIGtkYXRhKTsNCisgICAgaWYgKHJldCA8IDApIHsNCisgICAgICAgIHByaW50ayhLRVJOX0VS UiAiaTJjX3RyYW5zZmVyIHdyaXRlIGVycm9yICVkXG4iLCByZXQpOw0KKwkJa2ZyZWUoa2RhdGEp Ow0KKwkJcmV0dXJuIC0yMTsNCisJfQ0KKw0KKyAgICBpZiAoIGNvcHlfdG9fdXNlcigoY2hhciop IGJ1Ziwga2RhdGEsIEJVRkZFUl9TSVpFICkgKQ0KKyAgICB7DQorICAgICAgICBwcmludGsoS0VS Tl9FUlIgImNvcHlfdG9fdXNlciBmYWlsXG4iICk7DQorICAgICAgICByZXQgPSAtMTk7DQorICAg IH0NCisNCisgICAga2ZyZWUoIGtkYXRhICk7DQorDQorCXJldHVybiByZXQ7DQorfQ0KKw0KKy8q IGZvciBnZXQgc3lzdGVtIHRpbWUgKi8NCitzdGF0aWMgc3NpemVfdCBzaXNfY2Rldl9yZWFkKCBz dHJ1Y3QgZmlsZSAqZmlsZSwgY2hhciBfX3VzZXIgKmJ1ZiwgDQorc2l6ZV90IGNvdW50LCBsb2Zm X3QgKmZfcG9zICkgew0KKwkgaW50IHJldCA9IDA7DQorCSBjaGFyICprZGF0YTsNCisJIGNoYXIg Y21kOw0KKwkgaW50IGk7DQorCSANCisJIHByaW50ayhLRVJOX0lORk8gInNpc19jZGV2X3JlYWQu XG4iKTsNCisJIA0KKwkgaWYgKHRzX2JhayA9PSAwKQ0KKyAgICAJcmV0dXJuIC0xMzsNCisgICAg CQ0KKyAgICByZXQgPSBhY2Nlc3Nfb2soVkVSSUZZX1dSSVRFLCBidWYsIEJVRkZFUl9TSVpFKTsN CisgICAgaWYgKCFyZXQpIHsNCisgICAgICAgIHByaW50ayhLRVJOX0VSUiAiY2Fubm90IGFjY2Vz cyB1c2VyIHNwYWNlIG1lbW9yeVxuIik7DQorICAgICAgICByZXR1cm4gLTExOw0KKyAgICB9DQor DQorCSBrZGF0YSA9IGttYWxsb2MoQlVGRkVSX1NJWkUsIEdGUF9LRVJORUwpOw0KKyAgICAgaWYg KGtkYXRhID09IDApDQorICAgIAlyZXR1cm4gLTEyOw0KKyAgICAJDQorICAgICByZXQgPSBjb3B5 X2Zyb21fdXNlcihrZGF0YSwgYnVmLCBCVUZGRVJfU0laRSk7DQorICAgICBpZiAocmV0KSB7DQor ICAgICAgICBwcmludGsoS0VSTl9FUlIgImNvcHlfZnJvbV91c2VyIGZhaWxcbiIpOw0KKyAgICAg ICAga2ZyZWUoa2RhdGEpOw0KKyAgICAgICAgcmV0dXJuIC0xNDsNCisgICAgIH0gICAgDQorI2lm IDANCisgICAgUHJpbnRCdWZmZXIoMCwgY291bnQsIGtkYXRhKTsNCisjZW5kaWYNCisJIGNtZCA9 IGtkYXRhWzZdOw0KKwkgLyogZm9yIG1ha2luZyBzdXJlIEFQIGNvbW11bmljYXRlcyB3aXRoIFNp UyBkcml2ZXIgKi8NCisgICAgaWYoY21kID09IDB4YTIpDQorICAgIHsNCisJCWtkYXRhWzBdID0g NTsNCisJCWtkYXRhWzFdID0gMDsNCisJCWtkYXRhWzNdID0gJ1MnOw0KKwkJa2RhdGFbNF0gPSAn aSc7DQorCQlrZGF0YVs1XSA9ICdTJzsNCisJCWlmICggY29weV90b191c2VyKChjaGFyKikgYnVm LCBrZGF0YSwgQlVGRkVSX1NJWkUgKSApDQorCQl7DQorCQkJcHJpbnRrKEtFUk5fRVJSICJjb3B5 X3RvX3VzZXIgZmFpbFxuIiApOw0KKwkJCWtmcmVlKCBrZGF0YSApOw0KKwkJCXJldHVybiAtMTk7 DQorCQl9DQorDQorCQlrZnJlZSgga2RhdGEgKTsNCisJCXJldHVybiAzOwkNCisJfQ0KKy8qIFdy aXRlICYgUmVhZCAqLw0KKyAgICByZXQgPSBzaXNfY29tbWFuZF9mb3JfcmVhZCh0c19iYWstPmNs aWVudCwgTUFYX0JZVEUsIGtkYXRhKTsNCisgICAgaWYgKHJldCA8IDApIHsNCisgICAgICAgIHBy aW50ayhLRVJOX0VSUiAiaTJjX3RyYW5zZmVyIHJlYWQgZXJyb3IgJWRcbiIsIHJldCk7DQorCQlr ZnJlZShrZGF0YSk7DQorCQlyZXR1cm4gLTIxOw0KKwl9DQorDQorCXJldCA9IGtkYXRhWzBdIHwg KGtkYXRhWzFdIDw8IDgpOw0KKw0KKyAgICBwcmludGsoS0VSTl9JTkZPICIlZFxuIiwgcmV0KTsN CisNCisgICAgZm9yICggaSA9IDA7IGkgPCByZXQgJiYgaSA8IEJVRkZFUl9TSVpFOyBpKysgKQ0K KyAgICB7DQorICAgICAgICBwcmludGsoIiUwMnggIiwga2RhdGFbaV0pOw0KKyAgICB9DQorDQor ICAgIHByaW50ayggIlxuIiApOw0KKw0KKyAgICBpZiAoIGNvcHlfdG9fdXNlcigoY2hhciopIGJ1 Ziwga2RhdGEsIEJVRkZFUl9TSVpFICkgKQ0KKyAgICB7DQorICAgICAgICBwcmludGsoS0VSTl9F UlIgImNvcHlfdG9fdXNlciBmYWlsXG4iICk7DQorICAgICAgICByZXQgPSAtMTk7DQorICAgIH0N CisNCisgICAga2ZyZWUoIGtkYXRhICk7DQorDQorCXJldHVybiByZXQ7DQorfQ0KKw0KKyN1bmRl ZiBCVUZGRVJfU0laRQ0KKw0KK3N0YXRpYyBpbnQgc2lzX2NkZXZfb3BlbihzdHJ1Y3QgaW5vZGUg Kmlub2RlLCBzdHJ1Y3QgZmlsZSAqZmlscCkgew0KKwlwcmludGsoS0VSTl9JTkZPICJzaXNfY2Rl dl9vcGVuLlxuIik7DQorCWlmICggdHNfYmFrID09IDAgKQ0KKyAgICAJcmV0dXJuIC0xMzsNCisN CisJbXNsZWVwKDIwMCk7DQorCWlmICh0c19iYWstPnVzZV9pcnEpDQorCXsNCisjaWYgKCBMSU5V WF9WRVJTSU9OX0NPREUgPCBLRVJORUxfVkVSU0lPTiAoMiwgNiwgMzkpICkNCisgICAgICAgIGlm ICgodHNfYmFrLT5kZXNjLT5zdGF0dXMgJiBJUlFfRElTQUJMRUQpID09IA0KK0lSUV9TVEFUVVNf RU5BQkxFRCkgI2Vsc2UNCisJCWlmICgodHNfYmFrLT5kZXNjLT5pcnFfZGF0YS5zdGF0ZV91c2Vf YWNjZXNzb3JzICYgSVJRRF9JUlFfRElTQUJMRUQpID09IElSUV9TVEFUVVNfRU5BQkxFRCkNCisj ZW5kaWYJDQorCQl7DQorCQkJZGlzYWJsZV9pcnEodHNfYmFrLT5jbGllbnQtPmlycSk7DQorCQl9 DQorCQllbHNlDQorCQl7DQorI2lmICggTElOVVhfVkVSU0lPTl9DT0RFIDwgS0VSTkVMX1ZFUlNJ T04gKDIsIDYsIDM5KSApDQorCQkJcHJpbnRrKEtFUk5fSU5GTyAic2lzX2NkZXZfb3BlbjogSVJR X1NUQVRVUzogDQorJXhcbiIsKHRzX2Jhay0+ZGVzYy0+c3RhdHVzICYgSVJRX0RJU0FCTEVEKSk7 ICNlbHNlDQorCQkJcHJpbnRrKEtFUk5fSU5GTyAic2lzX2NkZXZfb3BlbjogSVJRX1NUQVRVUzog JXhcbiIsKHRzX2Jhay0+ZGVzYy0+aXJxX2RhdGEuc3RhdGVfdXNlX2FjY2Vzc29ycyAmIElSUURf SVJRX0RJU0FCTEVEKSk7DQorI2VuZGlmCQ0KKwkJfQ0KKwl9DQorCWhydGltZXJfY2FuY2VsKCZ0 c19iYWstPnRpbWVyKTsNCisNCisJLyogb25seSBmbHVzaCBzaXNfd3EgKi8NCisJZmx1c2hfd29y a3F1ZXVlKHNpc193cSk7IAkgICANCisgICAgDQorICAgIG1zbGVlcCgyMDApOw0KKw0KKwlyZXR1 cm4gMDsgLyogc3VjY2VzcyAqLw0KK30NCisNCitzdGF0aWMgaW50IHNpc19jZGV2X3JlbGVhc2Uo c3RydWN0IGlub2RlICppbm9kZSwgc3RydWN0IGZpbGUgKmZpbHApIHsNCisJcHJpbnRrKEtFUk5f SU5GTyAic2lzX2NkZXZfcmVsZWFzZS5cbiIpOw0KKwkNCisJbXNsZWVwKDIwMCk7DQorCQ0KKyAg ICBpZiAodHNfYmFrID09IDApDQorICAgIAlyZXR1cm4gLTEzOw0KKw0KKwlpZiAodHNfYmFrLT51 c2VfaXJxKQ0KKwl7DQorI2lmICggTElOVVhfVkVSU0lPTl9DT0RFIDwgS0VSTkVMX1ZFUlNJT04g KDIsIDYsIDM5KSApDQorICAgICAgICBpZiAoKHRzX2Jhay0+ZGVzYy0+c3RhdHVzICYgSVJRX0RJ U0FCTEVEKSA9PSANCitJUlFfU1RBVFVTX0RJU0FCTEVEKSAjZWxzZQ0KKwkJaWYgKCh0c19iYWst PmRlc2MtPmlycV9kYXRhLnN0YXRlX3VzZV9hY2Nlc3NvcnMgJiBJUlFEX0lSUV9ESVNBQkxFRCkg PT0gSVJRX1NUQVRVU19ESVNBQkxFRCkNCisjZW5kaWYJDQorCQl7DQorCQkJZW5hYmxlX2lycSh0 c19iYWstPmNsaWVudC0+aXJxKTsNCisJCX0NCisJfQ0KKwllbHNlDQorCQlocnRpbWVyX3N0YXJ0 KCZ0c19iYWstPnRpbWVyLCBrdGltZV9zZXQoMSwgMCksIEhSVElNRVJfTU9ERV9SRUwpOw0KKw0K KyAgICByZXR1cm4gMDsNCit9DQorDQorc3RhdGljIGNvbnN0IHN0cnVjdCBmaWxlX29wZXJhdGlv bnMgc2lzX2NkZXZfZm9wcyA9IHsNCisJLm93bmVyCT0gVEhJU19NT0RVTEUsDQorCS5yZWFkCT0g c2lzX2NkZXZfcmVhZCwNCisJLndyaXRlCT0gc2lzX2NkZXZfd3JpdGUsDQorCS5vcGVuCT0gc2lz X2NkZXZfb3BlbiwNCisJLnJlbGVhc2U9IHNpc19jZGV2X3JlbGVhc2UsDQorfTsNCisNCitzdGF0 aWMgaW50IHNpc19zZXR1cF9jaGFyZGV2KHN0cnVjdCBzaXNfdHNfZGF0YSAqdHMpIHsNCisJDQor CWRldl90IGRldiA9IE1LREVWKHNpc19jaGFyX21ham9yLCAwKTsNCisJaW50IGFsbG9jX3JldCA9 IDA7DQorCWludCBjZGV2X2VyciA9IDA7DQorCWludCBpbnB1dF9lcnIgPSAwOw0KKwlzdHJ1Y3Qg ZGV2aWNlICpjbGFzc19kZXYgPSBOVUxMOw0KKwl2b2lkICpwdHJfZXJyOw0KKwkNCisJcHJpbnRr KCJzaXNfc2V0dXBfY2hhcmRldi5cbiIpOw0KKwkNCisJaWYgKHRzID09IE5VTEwpIA0KKwl7DQor CSAgaW5wdXRfZXJyID0gLUVOT01FTTsNCisJICBnb3RvIGVycm9yOw0KKwl9IA0KKwkvKiBkeW5h bWljIGFsbG9jYXRlIGRyaXZlciBoYW5kbGUgKi8NCisJYWxsb2NfcmV0ID0gYWxsb2NfY2hyZGV2 X3JlZ2lvbigmZGV2LCAwLCBzaXNfY2hhcl9kZXZzX2NvdW50LCBERVZJQ0VfTkFNRSk7DQorCWlm IChhbGxvY19yZXQpDQorCQlnb3RvIGVycm9yOw0KKwkJDQorCXNpc19jaGFyX21ham9yID0gTUFK T1IoZGV2KTsNCisJY2Rldl9pbml0KCZzaXNfY2hhcl9jZGV2LCAmc2lzX2NkZXZfZm9wcyk7DQor CXNpc19jaGFyX2NkZXYub3duZXIgPSBUSElTX01PRFVMRTsNCisJY2Rldl9lcnIgPSBjZGV2X2Fk ZCgmc2lzX2NoYXJfY2RldiwgTUtERVYoc2lzX2NoYXJfbWFqb3IsIDApLCANCitzaXNfY2hhcl9k ZXZzX2NvdW50KTsNCisJDQorCWlmIChjZGV2X2VycikgDQorCQlnb3RvIGVycm9yOw0KKwkNCisJ cHJpbnRrKEtFUk5fSU5GTyAiJXMgZHJpdmVyKG1ham9yICVkKSBpbnN0YWxsZWQuXG4iLCBERVZJ Q0VfTkFNRSwgDQorc2lzX2NoYXJfbWFqb3IpOw0KKwkNCisJLyogcmVnaXN0ZXIgY2xhc3MgKi8N CisJc2lzX2NoYXJfY2xhc3MgPSBjbGFzc19jcmVhdGUoVEhJU19NT0RVTEUsIERFVklDRV9OQU1F KTsNCisJaWYoSVNfRVJSKHB0cl9lcnIgPSBzaXNfY2hhcl9jbGFzcykpIA0KKwl7DQorCQlnb3Rv IGVycjI7DQorCX0NCisJDQorCWNsYXNzX2RldiA9IGRldmljZV9jcmVhdGUoc2lzX2NoYXJfY2xh c3MsIE5VTEwsIE1LREVWKHNpc19jaGFyX21ham9yLCANCiswKSwgTlVMTCwgREVWSUNFX05BTUUp Ow0KKwkNCisJaWYoSVNfRVJSKHB0cl9lcnIgPSBjbGFzc19kZXYpKSANCisJew0KKwkJZ290byBl cnI7DQorCX0NCisJDQorCXJldHVybiAwOw0KK2Vycm9yOg0KKwlpZiAoY2Rldl9lcnIgPT0gMCkN CisJCWNkZXZfZGVsKCZzaXNfY2hhcl9jZGV2KTsNCisJaWYgKGFsbG9jX3JldCA9PSAwKQ0KKwkJ dW5yZWdpc3Rlcl9jaHJkZXZfcmVnaW9uKE1LREVWKHNpc19jaGFyX21ham9yLCAwKSwgc2lzX2No YXJfZGV2c19jb3VudCk7DQorCWlmKGlucHV0X2VyciAhPSAwKQ0KKwl7DQorCQlwcmludGsoInNp c190c19iYWsgZXJyb3IhXG4iKTsNCisJfQ0KK2VycjoNCisJZGV2aWNlX2Rlc3Ryb3koc2lzX2No YXJfY2xhc3MsIE1LREVWKHNpc19jaGFyX21ham9yLCAwKSk7DQorZXJyMjoNCisJY2xhc3NfZGVz dHJveShzaXNfY2hhcl9jbGFzcyk7DQorCXJldHVybiAtMTsNCit9DQorI2VuZGlmDQorDQorc3Rh dGljIGludCBzaXNfdHNfcHJvYmUoDQorCXN0cnVjdCBpMmNfY2xpZW50ICpjbGllbnQsIGNvbnN0 IHN0cnVjdCBpMmNfZGV2aWNlX2lkICppZCkgew0KKwlpbnQgcmV0ID0gMDsNCisJc3RydWN0IHNp c190c19kYXRhICp0cyA9IE5VTEw7DQorCXN0cnVjdCBzaXNfaTJjX3JtaV9wbGF0Zm9ybV9kYXRh ICpwZGF0YSA9IE5VTEw7DQorDQorICAgIHByaW50ayhLRVJOX0lORk8gInNpc190c19wcm9iZVxu Iik7DQorDQorICAgIFRQSW5mbyA9IGt6YWxsb2Moc2l6ZW9mKHN0cnVjdCBzaXNUUF9kcml2ZXJf ZGF0YSksIEdGUF9LRVJORUwpOw0KKyAgICBpZiAoVFBJbmZvID09IE5VTEwpIA0KKyAgICB7DQor CQlyZXQgPSAtRU5PTUVNOw0KKwkJZ290byBlcnJfYWxsb2NfZGF0YV9mYWlsZWQ7DQorCX0NCisN CisJdHMgPSBremFsbG9jKHNpemVvZihzdHJ1Y3Qgc2lzX3RzX2RhdGEpLCBHRlBfS0VSTkVMKTsN CisJaWYgKHRzID09IE5VTEwpIA0KKwl7DQorCQlyZXQgPSAtRU5PTUVNOw0KKwkJZ290byBlcnJf YWxsb2NfZGF0YV9mYWlsZWQ7DQorCX0NCisNCisJdHNfYmFrID0gdHM7DQorDQorCW11dGV4X2lu aXQoJnRzLT5tdXRleF93cSk7DQorCQ0KKwkvKiAxLiBJbml0IFdvcmsgcXVldWUgYW5kIG5lY2Vz c2FyeSBidWZmZXJzICovDQorCUlOSVRfV09SSygmdHMtPndvcmssIHNpc190c193b3JrX2Z1bmMp Ow0KKwl0cy0+Y2xpZW50ID0gY2xpZW50Ow0KKwlpMmNfc2V0X2NsaWVudGRhdGEoY2xpZW50LCB0 cyk7DQorICAgIHBkYXRhID0gY2xpZW50LT5kZXYucGxhdGZvcm1fZGF0YTsNCisNCisJaWYgKHBk YXRhKQ0KKwkJdHMtPnBvd2VyID0gcGRhdGEtPnBvd2VyOw0KKwlpZiAodHMtPnBvd2VyKSANCisJ ew0KKwkJcmV0ID0gdHMtPnBvd2VyKDEpOw0KKwkJaWYgKHJldCA8IDApIA0KKwkJew0KKwkJCXBy aW50ayhLRVJOX0VSUiAic2lzX3RzX3Byb2JlIHBvd2VyIG9uIGZhaWxlZFxuIik7DQorCQkJZ290 byBlcnJfcG93ZXJfZmFpbGVkOw0KKwkJfQ0KKwl9DQorDQorCS8qIDIuIEFsbG9jYXRlIGlucHV0 IGRldmljZSAqLw0KKwl0cy0+aW5wdXRfZGV2ID0gaW5wdXRfYWxsb2NhdGVfZGV2aWNlKCk7DQor CWlmICh0cy0+aW5wdXRfZGV2ID09IE5VTEwpIA0KKwl7DQorCQlyZXQgPSAtRU5PTUVNOw0KKwkJ cHJpbnRrKEtFUk5fRVJSICJzaXNfdHNfcHJvYmU6IEZhaWxlZCB0byBhbGxvY2F0ZSBpbnB1dCBk ZXZpY2VcbiIpOw0KKwkJZ290byBlcnJfaW5wdXRfZGV2X2FsbG9jX2ZhaWxlZDsNCisJfQ0KKw0K KwkvKiBUaGlzIGlucHV0IGRldmljZSBuYW1lIHNob3VsZCBiZSB0aGUgc2FtZSB0byBJREMgZmls ZSBuYW1lLiAqLw0KKwl0cy0+aW5wdXRfZGV2LT5uYW1lID0gInNpc190b3VjaCI7DQorDQorCXNl dF9iaXQoRVZfQUJTLCB0cy0+aW5wdXRfZGV2LT5ldmJpdCk7DQorCXNldF9iaXQoRVZfS0VZLCB0 cy0+aW5wdXRfZGV2LT5ldmJpdCk7DQorICAgIHNldF9iaXQoQUJTX01UX1BPU0lUSU9OX1gsIHRz LT5pbnB1dF9kZXYtPmFic2JpdCk7DQorICAgIHNldF9iaXQoQUJTX01UX1BPU0lUSU9OX1ksIHRz LT5pbnB1dF9kZXYtPmFic2JpdCk7DQorICAgIHNldF9iaXQoQUJTX01UX1RSQUNLSU5HX0lELCB0 cy0+aW5wdXRfZGV2LT5hYnNiaXQpOw0KKw0KKyNpZmRlZiBfQU5EUk9JRF80DQorCXNldF9iaXQo SU5QVVRfUFJPUF9ESVJFQ1QsIHRzLT5pbnB1dF9kZXYtPnByb3BiaXQpOw0KKyAgICBzZXRfYml0 KEFCU19NVF9QUkVTU1VSRSwgdHMtPmlucHV0X2Rldi0+YWJzYml0KTsNCisgICAgc2V0X2JpdChB QlNfTVRfVE9VQ0hfTUFKT1IsIHRzLT5pbnB1dF9kZXYtPmFic2JpdCk7DQorICAgIHNldF9iaXQo QUJTX01UX1RPVUNIX01JTk9SLCB0cy0+aW5wdXRfZGV2LT5hYnNiaXQpOw0KKyAgICBpbnB1dF9z ZXRfYWJzX3BhcmFtcyh0cy0+aW5wdXRfZGV2LCBBQlNfTVRfUFJFU1NVUkUsIDAsIFBSRVNTVVJF X01BWCwgMCwgMCk7DQorICAgIGlucHV0X3NldF9hYnNfcGFyYW1zKHRzLT5pbnB1dF9kZXYsIEFC U19NVF9UT1VDSF9NQUpPUiwgMCwgQVJFQV9MRU5HVEhfTE9OR0VSLCAwLCAwKTsNCisgICAgaW5w dXRfc2V0X2Fic19wYXJhbXModHMtPmlucHV0X2RldiwgQUJTX01UX1RPVUNIX01JTk9SLCAwLCBB UkVBX0xFTkdUSF9TSE9SVCwgMCwgMCk7ICAgDQorI2Vsc2UNCisgICAgc2V0X2JpdChBQlNfTVRf VE9VQ0hfTUFKT1IsIHRzLT5pbnB1dF9kZXYtPmFic2JpdCk7DQorICAgIHNldF9iaXQoQUJTX01U X1dJRFRIX01BSk9SLCB0cy0+aW5wdXRfZGV2LT5hYnNiaXQpOw0KKyAgICBzZXRfYml0KEFCU19N VF9XSURUSF9NSU5PUiwgdHMtPmlucHV0X2Rldi0+YWJzYml0KTsNCisgICAgaW5wdXRfc2V0X2Fi c19wYXJhbXModHMtPmlucHV0X2RldiwgQUJTX01UX1RPVUNIX01BSk9SLCAwLCBQUkVTU1VSRV9N QVgsIDAsIDApOw0KKyAgICBpbnB1dF9zZXRfYWJzX3BhcmFtcyh0cy0+aW5wdXRfZGV2LCBBQlNf TVRfV0lEVEhfTUFKT1IsIDAsIEFSRUFfTEVOR1RIX0xPTkdFUiwgMCwgMCk7DQorICAgIGlucHV0 X3NldF9hYnNfcGFyYW1zKHRzLT5pbnB1dF9kZXYsIEFCU19NVF9XSURUSF9NSU5PUiwgMCwgDQor QVJFQV9MRU5HVEhfU0hPUlQsIDAsIDApOyAjZW5kaWYNCisNCisgICAgaW5wdXRfc2V0X2Fic19w YXJhbXModHMtPmlucHV0X2RldiwgQUJTX01UX1BPU0lUSU9OX1gsIDAsIFNJU19NQVhfWCwgMCwg MCk7DQorICAgIGlucHV0X3NldF9hYnNfcGFyYW1zKHRzLT5pbnB1dF9kZXYsIEFCU19NVF9QT1NJ VElPTl9ZLCAwLCBTSVNfTUFYX1ksIDAsIDApOw0KKyAgICBpbnB1dF9zZXRfYWJzX3BhcmFtcyh0 cy0+aW5wdXRfZGV2LCBBQlNfTVRfVFJBQ0tJTkdfSUQsIDAsIDE1LCAwLCANCisgMCk7DQorCQ0K KyAgICAvKiBhZGQgZm9yIHRvdWNoIGtleXMgKi8NCisJc2V0X2JpdChLRVlfQ09NUE9TRSwgdHMt PmlucHV0X2Rldi0+a2V5Yml0KTsNCisJc2V0X2JpdChLRVlfQkFDSywgdHMtPmlucHV0X2Rldi0+ a2V5Yml0KTsNCisJc2V0X2JpdChLRVlfTUVOVSwgdHMtPmlucHV0X2Rldi0+a2V5Yml0KTsNCisJ c2V0X2JpdChLRVlfSE9NRSwgdHMtPmlucHV0X2Rldi0+a2V5Yml0KTsNCisNCisJLyogMy4gUmVn aXN0ZXIgaW5wdXQgZGV2aWNlIHRvIGNvcmUgKi8NCisJcmV0ID0gaW5wdXRfcmVnaXN0ZXJfZGV2 aWNlKHRzLT5pbnB1dF9kZXYpOw0KKw0KKwlpZiAocmV0KSANCisJew0KKwkJcHJpbnRrKEtFUk5f RVJSICJzaXNfdHNfcHJvYmU6IFVuYWJsZSB0byByZWdpc3RlciAlcyBpbnB1dCBkZXZpY2VcbiIs IHRzLT5pbnB1dF9kZXYtPm5hbWUpOw0KKwkJZ290byBlcnJfaW5wdXRfcmVnaXN0ZXJfZGV2aWNl X2ZhaWxlZDsNCisJfQ0KKwkNCisJLyogNC4gaXJxIG9yIHRpbWVyIHNldHVwICovDQorCXJldCA9 IGluaXRpYWxfaXJxKCk7DQorCWlmIChyZXQgPCAwKSANCisJew0KKw0KKwl9DQorCWVsc2UNCisJ ew0KKwkJY2xpZW50LT5pcnEgPSBncGlvX3RvX2lycShHUElPX0lSUSk7DQorCQlyZXQgPSByZXF1 ZXN0X2lycShjbGllbnQtPmlycSwgc2lzX3RzX2lycV9oYW5kbGVyLCBJUlFGX1RSSUdHRVJfRkFM TElORywgY2xpZW50LT5uYW1lLCB0cyk7DQorCQlpZiAocmV0ID09IDApIA0KKwkJew0KKwkJICAg dHMtPnVzZV9pcnEgPSAxOw0KKwkJfQ0KKwkJZWxzZSANCisJCXsNCisJCQlkZXZfZXJyKCZjbGll bnQtPmRldiwgInJlcXVlc3RfaXJxIGZhaWxlZFxuIik7DQorCQl9DQorCX0NCisNCisJdHMtPmRl c2MgPSBpcnFfdG9fZGVzYyh0c19iYWstPmNsaWVudC0+aXJxKTsNCisJDQorCWhydGltZXJfaW5p dCgmdHMtPnRpbWVyLCBDTE9DS19NT05PVE9OSUMsIEhSVElNRVJfTU9ERV9SRUwpOw0KKwl0cy0+ dGltZXIuZnVuY3Rpb24gPSBzaXNfdHNfdGltZXJfZnVuYzsNCisNCisJaWYgKCF0cy0+dXNlX2ly cSkgDQorCXsNCisJCWhydGltZXJfc3RhcnQoJnRzLT50aW1lciwga3RpbWVfc2V0KDEsIDApLCBI UlRJTUVSX01PREVfUkVMKTsNCisJfQ0KKw0KKyNpZmRlZiBDT05GSUdfSEFTX0VBUkxZU1VTUEVO RA0KKwl0cy0+ZWFybHlfc3VzcGVuZC5sZXZlbCA9IEVBUkxZX1NVU1BFTkRfTEVWRUxfQkxBTktf U0NSRUVOICsgMTsNCisJdHMtPmVhcmx5X3N1c3BlbmQuc3VzcGVuZCA9IHNpc190c19lYXJseV9z dXNwZW5kOw0KKwl0cy0+ZWFybHlfc3VzcGVuZC5yZXN1bWUgPSBzaXNfdHNfbGF0ZV9yZXN1bWU7 DQorCXJlZ2lzdGVyX2Vhcmx5X3N1c3BlbmQoJnRzLT5lYXJseV9zdXNwZW5kKTsNCisjZW5kaWYN CisJcHJpbnRrKEtFUk5fSU5GTyAic2lzX3RzX3Byb2JlOiBTdGFydCB0b3VjaHNjcmVlbiAlcyBp biAlcyBtb2RlXG4iLCANCit0cy0+aW5wdXRfZGV2LT5uYW1lLCB0cy0+dXNlX2lycSA/ICJpbnRl cnJ1cHQiIDogInBvbGxpbmciKTsNCisJDQorCWlmICh0cy0+dXNlX2lycSkNCisJew0KKyNpZmRl ZiBfSU5UX01PREVfMQ0KKwkJcHJpbnRrKEtFUk5fSU5GTyAic2lzX3RzX3Byb2JlOiBpbnRlcnJ1 cHQgY2FzZSAxIG1vZGVcbiIpOyAjZWxzZQ0KKwkJcHJpbnRrKEtFUk5fSU5GTyAic2lzX3RzX3By b2JlOiBpbnRlcnJ1cHQgY2FzZSAyIG1vZGVcbiIpOyAjZW5kaWYNCisJfQ0KKwkNCisjaWZkZWYg X1NURF9SV19JTw0KKwlyZXQgPSBzaXNfc2V0dXBfY2hhcmRldih0cyk7DQorCWlmKHJldCkNCisJ ew0KKwkJcHJpbnRrKCBLRVJOX0lORk8ic2lzX3NldHVwX2NoYXJkZXYgZmFpbFxuIik7DQorCX0N CisjZW5kaWYNCisNCisJcHJpbnRrKCBLRVJOX0lORk8ic2lzIFNJU19TTEFWRV9BRERSOiAlZFxu IiwgU0lTX1NMQVZFX0FERFIpOw0KKw0KKwlyZXR1cm4gMDsNCisNCitlcnJfaW5wdXRfcmVnaXN0 ZXJfZGV2aWNlX2ZhaWxlZDoNCisJaW5wdXRfZnJlZV9kZXZpY2UodHMtPmlucHV0X2Rldik7DQor DQorZXJyX2lucHV0X2Rldl9hbGxvY19mYWlsZWQ6DQorZXJyX3Bvd2VyX2ZhaWxlZDoNCisJa2Zy ZWUodHMpOw0KK2Vycl9hbGxvY19kYXRhX2ZhaWxlZDoNCisJcmV0dXJuIHJldDsNCit9DQorDQor c3RhdGljIGludCBzaXNfdHNfcmVtb3ZlKHN0cnVjdCBpMmNfY2xpZW50ICpjbGllbnQpIHsNCisJ c3RydWN0IHNpc190c19kYXRhICp0cyA9IGkyY19nZXRfY2xpZW50ZGF0YShjbGllbnQpOw0KKwkN CisjaWZkZWYgQ09ORklHX0hBU19FQVJMWVNVU1BFTkQNCisJdW5yZWdpc3Rlcl9lYXJseV9zdXNw ZW5kKCZ0cy0+ZWFybHlfc3VzcGVuZCk7DQorI2VuZGlmDQorCWlmICh0cy0+dXNlX2lycSkNCisJ CWZyZWVfaXJxKGNsaWVudC0+aXJxLCB0cyk7DQorCWVsc2UNCisJCWhydGltZXJfY2FuY2VsKCZ0 cy0+dGltZXIpOw0KKwlpbnB1dF91bnJlZ2lzdGVyX2RldmljZSh0cy0+aW5wdXRfZGV2KTsNCisJ a2ZyZWUodHMpOw0KKwkNCisJcmV0dXJuIDA7DQorfQ0KKw0KK3N0YXRpYyBpbnQgc2lzX3RzX3N1 c3BlbmQoc3RydWN0IGkyY19jbGllbnQgKmNsaWVudCwgcG1fbWVzc2FnZV90IG1lc2cpIA0KK3sN CisJaW50IHJldCA9IDA7DQorCXN0cnVjdCBzaXNfdHNfZGF0YSAqdHMgPSBpMmNfZ2V0X2NsaWVu dGRhdGEoY2xpZW50KTsNCisNCisJVFBJbmZvLT5wcmVfa2V5Yml0X3N0YXRlID0gMHgwOw0KKw0K KwlpZiAodHMtPnVzZV9pcnEpDQorCXsNCisjaWYgKCBMSU5VWF9WRVJTSU9OX0NPREUgPCBLRVJO RUxfVkVSU0lPTiAoMiwgNiwgMzkpICkNCisJCWlmICgodHMtPmRlc2MtPnN0YXR1cyAmIElSUV9E SVNBQkxFRCkgPT0gSVJRX1NUQVRVU19FTkFCTEVEKSAjZWxzZQ0KKwkJaWYgKCh0cy0+ZGVzYy0+ aXJxX2RhdGEuc3RhdGVfdXNlX2FjY2Vzc29ycyAmIElSUURfSVJRX0RJU0FCTEVEKSA9PSANCitJ UlFfU1RBVFVTX0VOQUJMRUQpICNlbmRpZg0KKwkJew0KKwkJCWRpc2FibGVfaXJxKGNsaWVudC0+ aXJxKTsNCisJCX0NCisJfQ0KKwllbHNlDQorCQlocnRpbWVyX2NhbmNlbCgmdHMtPnRpbWVyKTsN CisJLyogb25seSBmbHVzaCBzaXNfd3EgKi8NCisJZmx1c2hfd29ya3F1ZXVlKHNpc193cSk7IAkg ICAJCQ0KKw0KKwlpZiAodHMtPnBvd2VyKSB7DQorCQlyZXQgPSB0cy0+cG93ZXIoMCk7DQorCQlp ZiAocmV0IDwgMCkNCisJCQlwcmludGsoS0VSTl9FUlIgInNpc190c19zdXNwZW5kIHBvd2VyIG9m ZiBmYWlsZWRcbiIpOw0KKwl9DQorCQ0KKwlyZXR1cm4gMDsNCit9DQorDQorc3RhdGljIGludCBz aXNfdHNfcmVzdW1lKHN0cnVjdCBpMmNfY2xpZW50ICpjbGllbnQpIHsNCisJaW50IHJldCA9IDA7 DQorCXN0cnVjdCBzaXNfdHNfZGF0YSAqdHMgPSBpMmNfZ2V0X2NsaWVudGRhdGEoY2xpZW50KTsN CisNCisJaWYgKHRzLT5wb3dlcikNCisJew0KKwkJcmV0ID0gdHMtPnBvd2VyKDEpOw0KKwkJaWYg KHJldCA8IDApDQorCQkJcHJpbnRrKEtFUk5fRVJSICJzaXNfdHNfcmVzdW1lIHBvd2VyIG9uIGZh aWxlZFxuIik7DQorCX0NCisNCisJaWYgKHRzLT51c2VfaXJxKQ0KKwl7DQorI2lmICggTElOVVhf VkVSU0lPTl9DT0RFIDwgS0VSTkVMX1ZFUlNJT04gKDIsIDYsIDM5KSApDQorCQlpZiAoKHRzLT5k ZXNjLT5zdGF0dXMgJiBJUlFfRElTQUJMRUQpID09IElSUV9TVEFUVVNfRElTQUJMRUQpICNlbHNl DQorCQlpZiAoKHRzLT5kZXNjLT5pcnFfZGF0YS5zdGF0ZV91c2VfYWNjZXNzb3JzICYgSVJRRF9J UlFfRElTQUJMRUQpID09IA0KK0lSUV9TVEFUVVNfRElTQUJMRUQpICNlbmRpZg0KKwkJew0KKwkJ CWVuYWJsZV9pcnEoY2xpZW50LT5pcnEpOw0KKwkJfQ0KKwl9DQorCWVsc2UNCisJCWhydGltZXJf c3RhcnQoJnRzLT50aW1lciwga3RpbWVfc2V0KDEsIDApLCBIUlRJTUVSX01PREVfUkVMKTsNCisN CisJcmV0dXJuIDA7DQorfQ0KKw0KKyNpZmRlZiBDT05GSUdfSEFTX0VBUkxZU1VTUEVORA0KK3N0 YXRpYyB2b2lkIHNpc190c19lYXJseV9zdXNwZW5kKHN0cnVjdCBlYXJseV9zdXNwZW5kICpoKSB7 DQorCXN0cnVjdCBzaXNfdHNfZGF0YSAqdHM7DQorCQ0KKwlUUEluZm8tPnByZV9rZXliaXRfc3Rh dGUgPSAweDA7DQorCXRzID0gY29udGFpbmVyX29mKGgsIHN0cnVjdCBzaXNfdHNfZGF0YSwgZWFy bHlfc3VzcGVuZCk7DQorCXNpc190c19zdXNwZW5kKHRzLT5jbGllbnQsIFBNU0dfU1VTUEVORCk7 IH0NCisNCitzdGF0aWMgdm9pZCBzaXNfdHNfbGF0ZV9yZXN1bWUoc3RydWN0IGVhcmx5X3N1c3Bl bmQgKmgpIHsNCisJc3RydWN0IHNpc190c19kYXRhICp0czsNCisJDQorCXRzID0gY29udGFpbmVy X29mKGgsIHN0cnVjdCBzaXNfdHNfZGF0YSwgZWFybHlfc3VzcGVuZCk7DQorCXNpc190c19yZXN1 bWUodHMtPmNsaWVudCk7DQorfQ0KKyNlbmRpZg0KKw0KK3N0YXRpYyBjb25zdCBzdHJ1Y3QgaTJj X2RldmljZV9pZCBzaXNfdHNfaWRbXSA9IHsNCisJeyBTSVNfSTJDX05BTUUsIDAgfSwNCisJeyB9 DQorfTsNCisNCitNT0RVTEVfREVWSUNFX1RBQkxFKGkyYywgc2lzX3RzX2lkKTsNCisNCitzdGF0 aWMgc3RydWN0IGkyY19kcml2ZXIgc2lzX3RzX2RyaXZlciA9IHsNCisJLnByb2JlCQk9IHNpc190 c19wcm9iZSwNCisJLnJlbW92ZQkJPSBzaXNfdHNfcmVtb3ZlLA0KKyNpZm5kZWYgQ09ORklHX0hB U19FQVJMWVNVU1BFTkQNCisJLnN1c3BlbmQJPSBzaXNfdHNfc3VzcGVuZCwNCisJLnJlc3VtZQkJ PSBzaXNfdHNfcmVzdW1lLA0KKyNlbmRpZg0KKyNpZmRlZiBDT05GSUdfWDg2DQorICAgIC5jbGFz cyAgICAgID0gSTJDX0NMQVNTX0hXTU9OLA0KKyAgICAuZGV0ZWN0CQk9IHNpc190c19kZXRlY3Qs DQorCS5hZGRyZXNzX2xpc3QJPSBub3JtYWxfaTJjLA0KKyNlbmRpZg0KKwkuaWRfdGFibGUJPSBz aXNfdHNfaWQsDQorCS5kcml2ZXIgPSB7DQorCQkubmFtZQk9IFNJU19JMkNfTkFNRSwNCisJfSwN Cit9Ow0KKw0KK3N0YXRpYyBpbnQgX19pbml0IHNpc190c19pbml0KHZvaWQpDQorew0KKwlwcmlu dGsoIEtFUk5fSU5GTyAic2lzX3RzX2luaXRcbiIgKTsNCisJDQorCXNpc193cSA9IGNyZWF0ZV9z aW5nbGV0aHJlYWRfd29ya3F1ZXVlKCJzaXNfd3EiKTsNCisNCisJaWYgKCFzaXNfd3EpDQorCQly ZXR1cm4gLUVOT01FTTsNCisJCQ0KKwlyZXR1cm4gaTJjX2FkZF9kcml2ZXIoJnNpc190c19kcml2 ZXIpOyB9DQorDQorI2lmZGVmIENPTkZJR19YODYNCisvKiBSZXR1cm4gMCBpZiBkZXRlY3Rpb24g aXMgc3VjY2Vzc2Z1bCwgLUVOT0RFViBvdGhlcndpc2UgKi8gc3RhdGljIGludCANCitzaXNfdHNf ZGV0ZWN0KHN0cnVjdCBpMmNfY2xpZW50ICpjbGllbnQsDQorCQkgICAgICAgc3RydWN0IGkyY19i b2FyZF9pbmZvICppbmZvKQ0KK3sNCisJY29uc3QgY2hhciAqdHlwZV9uYW1lOw0KKwkNCisgICAg cHJpbnRrKEtFUk5fSU5GTyAic2lzX3RzX2RldGVjdFxuIik7DQorCQ0KKwl0eXBlX25hbWUgPSAi c2lzX2kyY190cyI7DQorCXN0cmxjcHkoaW5mby0+dHlwZSwgdHlwZV9uYW1lLCBJMkNfTkFNRV9T SVpFKTsNCisJDQorCXJldHVybiAwOw0KK30NCisjZW5kaWYNCisNCitzdGF0aWMgdm9pZCBfX2V4 aXQgc2lzX3RzX2V4aXQodm9pZCkNCit7DQorI2lmZGVmIF9TVERfUldfSU8NCisJZGV2X3QgZGV2 Ow0KKyNlbmRpZg0KKw0KKwlwcmludGsoS0VSTl9JTkZPICJzaXNfdHNfZXhpdFxuIik7DQorCQ0K KwlpMmNfZGVsX2RyaXZlcigmc2lzX3RzX2RyaXZlcik7DQorCQ0KKwlpZiAoc2lzX3dxKQ0KKwkJ ZGVzdHJveV93b3JrcXVldWUoc2lzX3dxKTsNCisNCisjaWZkZWYgX1NURF9SV19JTw0KKwlkZXYg PSBNS0RFVihzaXNfY2hhcl9tYWpvciwgMCk7DQorCWNkZXZfZGVsKCZzaXNfY2hhcl9jZGV2KTsN CisJdW5yZWdpc3Rlcl9jaHJkZXZfcmVnaW9uKGRldiwgc2lzX2NoYXJfZGV2c19jb3VudCk7DQor CWRldmljZV9kZXN0cm95KHNpc19jaGFyX2NsYXNzLCBNS0RFVihzaXNfY2hhcl9tYWpvciwgMCkp Ow0KKwljbGFzc19kZXN0cm95KHNpc19jaGFyX2NsYXNzKTsNCisjZW5kaWYNCit9DQorDQorbW9k dWxlX2luaXQoc2lzX3RzX2luaXQpOw0KK21vZHVsZV9leGl0KHNpc190c19leGl0KTsNCitNT0RV TEVfREVTQ1JJUFRJT04oIlNpUyA5MjAwIEZhbWlseSBUb3VjaHNjcmVlbiBEcml2ZXIiKTsgDQor TU9EVUxFX0xJQ0VOU0UoIkdQTCIpOw0KZGlmZiAtLWdpdCBhL2xpbnV4LTMuMTguMS9kcml2ZXJz L2lucHV0L3RvdWNoc2NyZWVuL3Npc19pMmMuaCBiL2xpbnV4LTMuMTguMS9kcml2ZXJzL2lucHV0 L3RvdWNoc2NyZWVuL3Npc19pMmMuaA0KbmV3IGZpbGUgbW9kZSAxMDA2NDQNCmluZGV4IDAwMDAw MDAuLmMxZDY1YzQNCi0tLSAvZGV2L251bGwNCisrKyBiL2xpbnV4LTMuMTguMS9kcml2ZXJzL2lu cHV0L3RvdWNoc2NyZWVuL3Npc19pMmMuaA0KQEAgLTAsMCArMSwyMTUgQEANCisvKg0KKyAqIGlu Y2x1ZGUvbGludXgvc2lzX2kyYy5oIC0gcGxhdGZvcm0gZGF0YSBzdHJ1Y3R1cmUgZm9yIFNpUyA5 MjAwIA0KK2ZhbWlseQ0KKyAqDQorICogQ29weXJpZ2h0IChDKSAyMDExIFNpUywgSW5jLg0KKyAq DQorICogVGhpcyBzb2Z0d2FyZSBpcyBsaWNlbnNlZCB1bmRlciB0aGUgdGVybXMgb2YgdGhlIEdO VSBHZW5lcmFsIFB1YmxpYw0KKyAqIExpY2Vuc2UgdmVyc2lvbiAyLCBhcyBwdWJsaXNoZWQgYnkg dGhlIEZyZWUgU29mdHdhcmUgRm91bmRhdGlvbiwgYW5kDQorICogbWF5IGJlIGNvcGllZCwgZGlz dHJpYnV0ZWQsIGFuZCBtb2RpZmllZCB1bmRlciB0aG9zZSB0ZXJtcy4NCisgKg0KKyAqIFRoaXMg cHJvZ3JhbSBpcyBkaXN0cmlidXRlZCBpbiB0aGUgaG9wZSB0aGF0IGl0IHdpbGwgYmUgdXNlZnVs LA0KKyAqIGJ1dCBXSVRIT1VUIEFOWSBXQVJSQU5UWTsgd2l0aG91dCBldmVuIHRoZSBpbXBsaWVk IHdhcnJhbnR5IG9mDQorICogTUVSQ0hBTlRBQklMSVRZIG9yIEZJVE5FU1MgRk9SIEEgUEFSVElD VUxBUiBQVVJQT1NFLiAgU2VlIHRoZQ0KKyAqIEdOVSBHZW5lcmFsIFB1YmxpYyBMaWNlbnNlIGZv ciBtb3JlIGRldGFpbHMuDQorICoNCisgKiBEYXRlOiAyMDE1LzAxLzE1DQorICogVmVyc2lvbjoJ QW5kcm9pZF92Mi4wNS4wMC1BNjM5LTExMTMNCisgKi8NCisjaW5jbHVkZSA8bGludXgvdmVyc2lv bi5oPg0KKw0KKyNpZm5kZWYgX0xJTlVYX1NJU19JMkNfSA0KKyNkZWZpbmUgX0xJTlVYX1NJU19J MkNfSA0KKw0KKw0KKyNkZWZpbmUgU0lTX0kyQ19OQU1FICJzaXNfaTJjX3RzIg0KKyNkZWZpbmUg U0lTX1NMQVZFX0FERFIJCQkJCTB4NWMNCisjZGVmaW5lIFRJTUVSX05TICAgIAkJCQkJMTAwMDAw MDAgLy8xMG1zDQorI2RlZmluZSBNQVhfRklOR0VSUwkJCQkJCTEwDQorDQorDQorLyogRm9yIEFu ZHJvaWQgNC4wIAkJCQkJCQkqLw0KKy8qIE9ubHkgZm9yIExpbnV4IGtlcm5lbCAyLjYuMzQgYW5k IGxhdGVyIAkqLw0KKyNkZWZpbmUgX0FORFJPSURfNAkJCQkJLy8gIE9OL09GRg0KKw0KKy8qIEZv ciBzdGFuZGFyZCBSL1cgSU8qLw0KKyNkZWZpbmUgX1NURF9SV19JTwkJCQkJCS8vICBPTi9PRkYN CisNCisvKiBJbnRlcnJ1cHQgc2V0dGluZyBhbmQgbW9kZXMgKi8NCisjZGVmaW5lIF9JMkNfSU5U X0VOQUJMRQkJCQkJLy8gIE9OL09GRg0KKyNkZWZpbmUgR1BJT19JUlEgCQkJCQkJMTMzDQorDQor LyogIEVuYWJsZSBpZiB1c2UgaW50ZXJydXB0IGNhc2UgMSBtb2RlLiAgKi8NCisvKiAJRGlzYWJs ZSBpZiB1c2UgaW50ZXJydXB0IGNhc2UgMiBtb2RlLiAqLw0KKy8vI2RlZmluZSBfSU5UX01PREVf MQkJCQkJLy8JT04vT0ZGDQorDQorLyogSVJRIFNUQVRVUyAqLw0KKyNpZiAoIExJTlVYX1ZFUlNJ T05fQ09ERSA8IEtFUk5FTF9WRVJTSU9OICgyLCA2LCAzOSkgKQ0KKyNkZWZpbmUgSVJRX1NUQVRV U19ESVNBQkxFRAkJCQkweDIwMCAgDQorI2Vsc2UNCisjZGVmaW5lIElSUV9TVEFUVVNfRElTQUJM RUQJCQkJKDE8PDE2KQ0KKyNlbmRpZg0KKyNkZWZpbmUgSVJRX1NUQVRVU19FTkFCTEVECQkJCTB4 MA0KKw0KKy8qIFJlc29sdXRpb24gbW9kZSAqLw0KKy8vIENvbnN0YW50IHZhbHVlIA0KKyNkZWZp bmUgU0lTX01BWF9YCQkJCQkJNDA5NQ0KKyNkZWZpbmUgU0lTX01BWF9ZCQkJCQkJNDA5NQ0KKw0K KyNkZWZpbmUgT05FX0JZVEUJCQkJCQkxDQorI2RlZmluZSBGSVZFX0JZVEUJCQkJCQk1DQorI2Rl ZmluZSBFSUdIVF9CWVRFICAJCQkJCTgNCisjZGVmaW5lIFNJWFRFRU5fQllURQkJCQkJMTYNCisj ZGVmaW5lIFBBQ0tFVF9CVUZGRVJfU0laRQkJCQkxMjgNCisNCisjZGVmaW5lIFNJU19DTURfTk9S TUFMCQkJCQkweDANCisjZGVmaW5lIFNJU19DTURfU09GVFJFU0VUCQkJCTB4ODINCisjZGVmaW5l IFNJU19DTURfUkVDQUxJQlJBVEUJCQkJMHg4Nw0KKyNkZWZpbmUgU0lTX0NNRF9QT1dFUk1PREUg ICAgICAgCQkweDkwDQorI2RlZmluZSBNU0tfVE9VQ0hOVU0JCQkJCTB4MGYNCisjZGVmaW5lIE1T S19IQVNfQ1JDCQkJCQkJMHgxMA0KKyNkZWZpbmUgTVNLX0RBVEFGTVQJCQkJCQkweGUwDQorI2Rl ZmluZSBNU0tfUFNUQVRFCQkJCQkJMHgwZg0KKyNkZWZpbmUgTVNLX1BJRAkgICAgICAgICAgICAg ICAgCQkweGYwDQorI2RlZmluZSBSRVNfRk1UCQkJCQkJCTB4MDANCisjZGVmaW5lIEZJWF9GTVQJ CQkJCQkJMHg0MA0KKw0KKy8qIGZvciBuZXcgaTJjIGZvcm1hdCAqLw0KKyNkZWZpbmUgVE9VQ0hE T1dOCQkJCQkJMHgzDQorI2RlZmluZSBUT1VDSFVQCQkJCQkJCTB4MA0KKyNkZWZpbmUgTUFYX0JZ VEUJCQkJCQk2NA0KKyNkZWZpbmUJUFJFU1NVUkVfTUFYCQkJCQkyNTUNCisNCisjaWZkZWYgX0FO RFJPSURfNA0KKyNkZWZpbmUgQVJFQV9MRU5HVEhfTE9OR0VSCQkJCTU3OTIgLy9SZXNvbHV0aW9u IGRpYWdvbmFsIA0KKyNkZWZpbmUgQVJFQV9MRU5HVEhfU0hPUlQJCQkJNTc5MiAvLyAoKFNJU19N QVhfWF4yKSArIChTSVNfTUFYX1leMikpXjAuNQ0KKyNkZWZpbmUgQVJFQV9VTklUCQkJCQkJKDU3 OTIvMzIpDQorI2Vsc2UNCisjZGVmaW5lIEFSRUFfTEVOR1RIX0xPTkdFUgkJCQkzMQ0KKyNkZWZp bmUgQVJFQV9MRU5HVEhfU0hPUlQJCQkJMzENCisjZW5kaWYNCisNCisNCisjZGVmaW5lIEZPUk1B VF9NT0RFCQkJCQkJMQ0KKw0KKyNkZWZpbmUgTVNLX05PQlROCQkJCQkJMA0KKyNkZWZpbmUgTVNL X0NPTVAJCQkJCQkxDQorI2RlZmluZSBNU0tfQkFDSwkJCQkJCTINCisjZGVmaW5lIE1TS19NRU5V CQkJCQkJNA0KKyNkZWZpbmUgTVNLX0hPTUUJCQkJCQk4DQorDQorI2RlZmluZSBQX0JZVEVDT1VO VAkJCQkJCTAgDQorI2RlZmluZSBBTExfSU5fT05FX1BBQ0tBR0UJCQkJMHgxMA0KKyNkZWZpbmUg SVNfVE9VQ0goeCkJCQkJCQkoeCAmIDB4MSkNCisjZGVmaW5lIElTX0hJREkyQyh4KQkJCQkJKHgg JiAweDYpDQorI2RlZmluZSBJU19BUkVBKHgpCQkJCQkJKCh4ID4+IDQpICYgMHgxKQ0KKyNkZWZp bmUgSVNfUFJFU1NVUkUoeCkJCQkJICAgICgoeCA+PiA1KSAmIDB4MSkNCisjZGVmaW5lIElTX1ND QU5USU1FKHgpCQkJICAgICAgICAoKHggPj4gNikgJiAweDEpDQorLy8jZGVmaW5lIF9ERUJVR19Q QUNLQUdFCQkJCS8vICBPTi9PRkYNCisvLyNkZWZpbmUgX0RFQlVHX1JFUE9SVAkJCQkJLy8gIE9O L09GRg0KKyNkZWZpbmUgTk9STUFMX0xFTl9QRVJfUE9JTlQJCQk2DQorI2RlZmluZSBBUkVBX0xF Tl9QRVJfUE9JTlQJCQkJMg0KKyNkZWZpbmUgUFJFU1NVUkVfTEVOX1BFUl9QT0lOVAkJCTENCisN CisvLyNkZWZpbmUgX0NIRUNLX0NSQwkJCQkJLy8gIE9OL09GRg0KKy8vI2RlZmluZSBfU1VQUE9S VF9CVVRUT05fVE9VQ0gJCQkvLyAgT04vT0ZGDQorI2RlZmluZSBUT1VDSF9GT1JNQVQJCQkJCTB4 MQ0KKyNkZWZpbmUgQlVUVE9OX0ZPUk1BVAkJCQkJMHg0DQorI2RlZmluZSBISURJMkNfRk9STUFU CQkJCQkweDYNCisjZGVmaW5lIFBfUkVQT1JUX0lECQkJCQkJMg0KKyNkZWZpbmUgQlVUVE9OX1NU QVRFCQkJCQkzDQorI2RlZmluZSBCVVRUT05fS0VZX0NPVU5UCQkJCTE2DQorI2RlZmluZSBCWVRF X0JZVEVDT1VOVAkJCQkJMg0KKyNkZWZpbmUgQllURV9DT1VOVAkJCQkJCTENCisjZGVmaW5lIEJZ VEVfUmVwb3J0SUQJCQkJCTENCisjZGVmaW5lIEJZVEVfQ1JDX0hJREkyQwkJCQkJMA0KKyNkZWZp bmUgQllURV9DUkNfSTJDCQkJCQkyDQorI2RlZmluZSBCWVRFX1NDQU5USU1FCQkJCQkyDQorI2Rl ZmluZSBOT19UT1VDSF9CWVRFQ09VTlQJCQkJMHgzDQorDQorLyogVE9ETyAqLw0KKyNkZWZpbmUg VE9VQ0hfUE9XRVJfUElOCQkJCQkwDQorI2RlZmluZSBUT1VDSF9SRVNFVF9QSU4JCQkJCTENCisN CisvKiBDTUQgRGVmaW5lICovDQorI2RlZmluZSBCVUZfQUNLX1BMQUNFX0wJCQkJCTQNCisjZGVm aW5lIEJVRl9BQ0tfUExBQ0VfSAkJCQkJNQ0KKyNkZWZpbmUgQlVGX0FDS19MCQkJCQkJMHhFRg0K KyNkZWZpbmUgQlVGX0FDS19ICQkJCQkJMHhCRQ0KKyNkZWZpbmUgQlVGX05BQ0tfTAkJCQkJCTB4 QUQNCisjZGVmaW5lIEJVRl9OQUNLX0gJCQkJCQkweERFDQorI2RlZmluZSBCVUZfQ1JDX1BMQUNF CQkJCQk3DQorDQorDQorDQorc3RydWN0IHNpc19pMmNfcm1pX3BsYXRmb3JtX2RhdGEgew0KKwlp bnQgKCpwb3dlcikoaW50IG9uKTsJLyogT25seSB2YWxpZCBpbiBmaXJzdCBhcnJheSBlbnRyeSAq Lw0KK307DQorDQorc3RhdGljIGNvbnN0IHVuc2lnbmVkIHNob3J0IGNyYzE2dGFiWzI1Nl09IHsN CisJCTB4MDAwMCwweDEwMjEsMHgyMDQyLDB4MzA2MywweDQwODQsMHg1MGE1LDB4NjBjNiwweDcw ZTcsDQorICAgICAgICAweDgxMDgsMHg5MTI5LDB4YTE0YSwweGIxNmIsMHhjMThjLDB4ZDFhZCww eGUxY2UsMHhmMWVmLA0KKyAgICAgICAgMHgxMjMxLDB4MDIxMCwweDMyNzMsMHgyMjUyLDB4NTJi NSwweDQyOTQsMHg3MmY3LDB4NjJkNiwNCisgICAgICAgIDB4OTMzOSwweDgzMTgsMHhiMzdiLDB4 YTM1YSwweGQzYmQsMHhjMzljLDB4ZjNmZiwweGUzZGUsDQorICAgICAgICAweDI0NjIsMHgzNDQz LDB4MDQyMCwweDE0MDEsMHg2NGU2LDB4NzRjNywweDQ0YTQsMHg1NDg1LA0KKyAgICAgICAgMHhh NTZhLDB4YjU0YiwweDg1MjgsMHg5NTA5LDB4ZTVlZSwweGY1Y2YsMHhjNWFjLDB4ZDU4ZCwNCisg ICAgICAgIDB4MzY1MywweDI2NzIsMHgxNjExLDB4MDYzMCwweDc2ZDcsMHg2NmY2LDB4NTY5NSww eDQ2YjQsDQorICAgICAgICAweGI3NWIsMHhhNzdhLDB4OTcxOSwweDg3MzgsMHhmN2RmLDB4ZTdm ZSwweGQ3OWQsMHhjN2JjLA0KKyAgICAgICAgMHg0OGM0LDB4NThlNSwweDY4ODYsMHg3OGE3LDB4 MDg0MCwweDE4NjEsMHgyODAyLDB4MzgyMywNCisgICAgICAgIDB4YzljYywweGQ5ZWQsMHhlOThl LDB4ZjlhZiwweDg5NDgsMHg5OTY5LDB4YTkwYSwweGI5MmIsDQorICAgICAgICAweDVhZjUsMHg0 YWQ0LDB4N2FiNywweDZhOTYsMHgxYTcxLDB4MGE1MCwweDNhMzMsMHgyYTEyLA0KKyAgICAgICAg MHhkYmZkLDB4Y2JkYywweGZiYmYsMHhlYjllLDB4OWI3OSwweDhiNTgsMHhiYjNiLDB4YWIxYSwN CisgICAgICAgIDB4NmNhNiwweDdjODcsMHg0Y2U0LDB4NWNjNSwweDJjMjIsMHgzYzAzLDB4MGM2 MCwweDFjNDEsDQorICAgICAgICAweGVkYWUsMHhmZDhmLDB4Y2RlYywweGRkY2QsMHhhZDJhLDB4 YmQwYiwweDhkNjgsMHg5ZDQ5LA0KKyAgICAgICAgMHg3ZTk3LDB4NmViNiwweDVlZDUsMHg0ZWY0 LDB4M2UxMywweDJlMzIsMHgxZTUxLDB4MGU3MCwNCisgICAgICAgIDB4ZmY5ZiwweGVmYmUsMHhk ZmRkLDB4Y2ZmYywweGJmMWIsMHhhZjNhLDB4OWY1OSwweDhmNzgsDQorICAgICAgICAweDkxODgs MHg4MWE5LDB4YjFjYSwweGExZWIsMHhkMTBjLDB4YzEyZCwweGYxNGUsMHhlMTZmLA0KKyAgICAg ICAgMHgxMDgwLDB4MDBhMSwweDMwYzIsMHgyMGUzLDB4NTAwNCwweDQwMjUsMHg3MDQ2LDB4NjA2 NywNCisgICAgICAgIDB4ODNiOSwweDkzOTgsMHhhM2ZiLDB4YjNkYSwweGMzM2QsMHhkMzFjLDB4 ZTM3ZiwweGYzNWUsDQorICAgICAgICAweDAyYjEsMHgxMjkwLDB4MjJmMywweDMyZDIsMHg0MjM1 LDB4NTIxNCwweDYyNzcsMHg3MjU2LA0KKyAgICAgICAgMHhiNWVhLDB4YTVjYiwweDk1YTgsMHg4 NTg5LDB4ZjU2ZSwweGU1NGYsMHhkNTJjLDB4YzUwZCwNCisgICAgICAgIDB4MzRlMiwweDI0YzMs MHgxNGEwLDB4MDQ4MSwweDc0NjYsMHg2NDQ3LDB4NTQyNCwweDQ0MDUsDQorICAgICAgICAweGE3 ZGIsMHhiN2ZhLDB4ODc5OSwweDk3YjgsMHhlNzVmLDB4Zjc3ZSwweGM3MWQsMHhkNzNjLA0KKyAg ICAgICAgMHgyNmQzLDB4MzZmMiwweDA2OTEsMHgxNmIwLDB4NjY1NywweDc2NzYsMHg0NjE1LDB4 NTYzNCwNCisgICAgICAgIDB4ZDk0YywweGM5NmQsMHhmOTBlLDB4ZTkyZiwweDk5YzgsMHg4OWU5 LDB4Yjk4YSwweGE5YWIsDQorICAgICAgICAweDU4NDQsMHg0ODY1LDB4NzgwNiwweDY4MjcsMHgx OGMwLDB4MDhlMSwweDM4ODIsMHgyOGEzLA0KKyAgICAgICAgMHhjYjdkLDB4ZGI1YywweGViM2Ys MHhmYjFlLDB4OGJmOSwweDliZDgsMHhhYmJiLDB4YmI5YSwNCisgICAgICAgIDB4NGE3NSwweDVh NTQsMHg2YTM3LDB4N2ExNiwweDBhZjEsMHgxYWQwLDB4MmFiMywweDNhOTIsDQorICAgICAgICAw eGZkMmUsMHhlZDBmLDB4ZGQ2YywweGNkNGQsMHhiZGFhLDB4YWQ4YiwweDlkZTgsMHg4ZGM5LA0K KyAgICAgICAgMHg3YzI2LDB4NmMwNywweDVjNjQsMHg0YzQ1LDB4M2NhMiwweDJjODMsMHgxY2Uw LDB4MGNjMSwNCisgICAgICAgIDB4ZWYxZiwweGZmM2UsMHhjZjVkLDB4ZGY3YywweGFmOWIsMHhi ZmJhLDB4OGZkOSwweDlmZjgsDQorICAgICAgICAweDZlMTcsMHg3ZTM2LDB4NGU1NSwweDVlNzQs MHgyZTkzLDB4M2ViMiwweDBlZDEsMHgxZWYwDQorfTsNCisNCitzdHJ1Y3QgUG9pbnQgew0KKwlp bnQgaWQ7DQorCXVuc2lnbmVkIHNob3J0IHgsIHk7ICAgCS8vIHVpbnQxNl90ID8NCisJdWludDE2 X3QgUHJlc3N1cmU7DQorCXVpbnQxNl90IFdpZHRoOw0KKwl1aW50MTZfdCBIZWlnaHQ7DQorfTsN CisNCitzdHJ1Y3Qgc2lzVFBfZHJpdmVyX2RhdGEgew0KKwlpbnQgaWQ7DQorCWludCBmaW5nZXJz Ow0KKwl1aW50OF90IHByZV9rZXliaXRfc3RhdGU7CQ0KKwlzdHJ1Y3QgUG9pbnQgcHRbTUFYX0ZJ TkdFUlNdOw0KK307DQorDQorc3RydWN0IHNpc190c19kYXRhIHsNCisJaW50ICgqcG93ZXIpKGlu dCBvbik7DQorCWludCB1c2VfaXJxOw0KKwlzdHJ1Y3QgaTJjX2NsaWVudCAqY2xpZW50Ow0KKwlz dHJ1Y3QgaW5wdXRfZGV2ICppbnB1dF9kZXY7DQorCXN0cnVjdCBocnRpbWVyIHRpbWVyOw0KKwlz dHJ1Y3QgaXJxX2Rlc2MgKmRlc2M7DQorCXN0cnVjdCB3b3JrX3N0cnVjdCB3b3JrOw0KKwlzdHJ1 Y3QgbXV0ZXggbXV0ZXhfd3E7DQorI2lmZGVmIENPTkZJR19IQVNfRUFSTFlTVVNQRU5EDQorCXN0 cnVjdCBlYXJseV9zdXNwZW5kIGVhcmx5X3N1c3BlbmQ7DQorI2VuZGlmDQorfTsNCisNCitzdGF0 aWMgaW50IHNpc190c19zdXNwZW5kKHN0cnVjdCBpMmNfY2xpZW50ICpjbGllbnQsIHBtX21lc3Nh Z2VfdCANCittZXNnKTsgc3RhdGljIGludCBzaXNfdHNfcmVzdW1lKHN0cnVjdCBpMmNfY2xpZW50 ICpjbGllbnQpOw0KKw0KKyNlbmRpZiAvKiBfTElOVVhfU0lTX0kyQ19IICovDQo=