Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
Move digitizer power management into ts_srv
Change-Id: Ie540b9619d3c79e0ce31589caae3aa979404da34
- Loading branch information
Showing
5 changed files
with
224 additions
and
133 deletions.
There are no files selected for viewing
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| Original file line number | Diff line number | Diff line change |
|---|---|---|
| @@ -0,0 +1,176 @@ | ||
| /* | ||
| * This is a userspace power management driver for the digitizer in the HP | ||
| * Touchpad to turn the digitizer on and off. | ||
| * | ||
| * This program is free software; you can redistribute it and/or modify | ||
| * it under the terms of the GNU General Public License version 2 and | ||
| * only version 2 as published by the Free Software Foundation. | ||
| * | ||
| * This program is distributed in the hope that it will be useful, | ||
| * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
| * GNU General Public License for more details. | ||
| * | ||
| * You should have received a copy of the GNU General Public License | ||
| * along with this program; if not, write to the Free Software | ||
| * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA | ||
| * 02110-1301, USA. | ||
| * | ||
| * | ||
| * Copyright (c) 2012 CyanogenMod Touchpad Project. | ||
| * | ||
| * | ||
| */ | ||
|
|
||
| #include <stdio.h> | ||
| #include <linux/i2c.h> | ||
| #include <linux/i2c-dev.h> | ||
| #include <sys/ioctl.h> | ||
| #include <errno.h> | ||
| #include <fcntl.h> | ||
|
|
||
| #include "digitizer.h" | ||
|
|
||
| static int vdd_fd, xres_fd, wake_fd, i2c_fd, ts_state; | ||
|
|
||
| void touchscreen_power(int enable) | ||
| { | ||
| struct i2c_rdwr_ioctl_data i2c_ioctl_data; | ||
| struct i2c_msg i2c_msg; | ||
| __u8 i2c_buf[16]; | ||
| int rc; | ||
|
|
||
| if (enable && !ts_state) { | ||
| int retry_count = 0; | ||
| try_again: | ||
| /* Set reset so the chip immediatelly sees it */ | ||
| lseek(xres_fd, 0, SEEK_SET); | ||
| rc = write(xres_fd, "1", 1); | ||
| if (rc != 1) | ||
| printf("TSpower, failed set xres"); | ||
|
|
||
| /* Then power on */ | ||
| lseek(vdd_fd, 0, SEEK_SET); | ||
| rc = write(vdd_fd, "1", 1); | ||
| if (rc != 1) | ||
| printf("TSpower, failed to enable vdd"); | ||
|
|
||
| /* Sleep some more for the voltage to stabilize */ | ||
| usleep(50000); | ||
|
|
||
| lseek(wake_fd, 0, SEEK_SET); | ||
| rc = write(wake_fd, "1", 1); | ||
| if (rc != 1) | ||
| printf("TSpower, failed to assert wake"); | ||
|
|
||
| lseek(xres_fd, 0, SEEK_SET); | ||
| rc = write(xres_fd, "0", 1); | ||
| if (rc != 1) | ||
| printf("TSpower, failed to reset xres"); | ||
|
|
||
| usleep(50000); | ||
|
|
||
| lseek(wake_fd, 0, SEEK_SET); | ||
| rc = write(wake_fd, "0", 1); | ||
| if (rc != 1) | ||
| printf("TSpower, failed to deassert wake"); | ||
|
|
||
| usleep(50000); | ||
|
|
||
| i2c_ioctl_data.nmsgs = 1; | ||
| i2c_ioctl_data.msgs = &i2c_msg; | ||
|
|
||
| i2c_msg.addr = 0x67; | ||
| i2c_msg.flags = 0; | ||
| i2c_msg.buf = i2c_buf; | ||
|
|
||
| i2c_msg.len = 2; | ||
| i2c_buf[0] = 0x08; i2c_buf[1] = 0; | ||
| rc = ioctl(i2c_fd,I2C_RDWR,&i2c_ioctl_data); | ||
| if (rc != 1) | ||
| printf("TSPower, ioctl1 failed %d errno %d\n", rc, errno); | ||
| /* Ok, so the TS failed to wake, we need to retry a few times | ||
| * before totally giving up */ | ||
| if ((rc != 1) && (retry_count++ < MAX_DIGITIZER_RETRY)) { | ||
| lseek(vdd_fd, 0, SEEK_SET); | ||
| rc = write(vdd_fd, "0", 1); | ||
| usleep(10000); | ||
| printf("TS wakeup retry #%d\n", retry_count); | ||
| goto try_again; | ||
| } | ||
|
|
||
| i2c_msg.len = 6; | ||
| i2c_buf[0] = 0x31; i2c_buf[1] = 0x01; i2c_buf[2] = 0x08; | ||
| i2c_buf[3] = 0x0C; i2c_buf[4] = 0x0D; i2c_buf[5] = 0x0A; | ||
| rc = ioctl(i2c_fd,I2C_RDWR,&i2c_ioctl_data); | ||
| if (rc != 1) | ||
| printf("TSPower, ioctl2 failed %d errno %d\n", rc, errno); | ||
|
|
||
| i2c_msg.len = 2; | ||
| i2c_buf[0] = 0x30; i2c_buf[1] = 0x0F; | ||
| rc = ioctl(i2c_fd,I2C_RDWR,&i2c_ioctl_data); | ||
| if (rc != 1) | ||
| printf("TSPower, ioctl3 failed %d errno %d\n", rc, errno); | ||
|
|
||
| i2c_buf[0] = 0x40; i2c_buf[1] = 0x02; | ||
| rc = ioctl(i2c_fd,I2C_RDWR,&i2c_ioctl_data); | ||
| if (rc != 1) | ||
| printf("TSPower, ioctl4 failed %d errno %d\n", rc, errno); | ||
|
|
||
| i2c_buf[0] = 0x41; i2c_buf[1] = 0x10; | ||
| rc = ioctl(i2c_fd,I2C_RDWR,&i2c_ioctl_data); | ||
| if (rc != 1) | ||
| printf("TSPower, ioctl5 failed %d errno %d\n", rc, errno); | ||
|
|
||
| i2c_buf[0] = 0x0A; i2c_buf[1] = 0x04; | ||
| rc = ioctl(i2c_fd,I2C_RDWR,&i2c_ioctl_data); | ||
| if (rc != 1) | ||
| printf("TSPower, ioctl6 failed %d errno %d\n", rc, errno); | ||
|
|
||
| i2c_buf[0] = 0x08; i2c_buf[1] = 0x03; | ||
| rc = ioctl(i2c_fd,I2C_RDWR,&i2c_ioctl_data); | ||
| if (rc != 1) | ||
| printf("TSPower, ioctl7 failed %d errno %d\n", rc, errno); | ||
|
|
||
| lseek(wake_fd, 0, SEEK_SET); | ||
| rc = write(wake_fd, "1", 1); | ||
| if (rc != 1) | ||
| printf("TSpower, failed to assert wake again"); | ||
| ts_state = 1; | ||
| } else if (ts_state) { | ||
| lseek(vdd_fd, 0, SEEK_SET); | ||
| rc = write(vdd_fd, "0", 1); | ||
| if (rc != 1) | ||
| printf("TSpower, failed to disable vdd"); | ||
|
|
||
| /* Weird, but on 4G touchpads even after vdd is off there is still | ||
| * stream of data from ctp that only disappears after we reset the | ||
| * touchscreen, even though it's supposedly powered off already | ||
| */ | ||
| lseek(xres_fd, 0, SEEK_SET); | ||
| rc = write(xres_fd, "1", 1); | ||
| usleep(10000); | ||
| lseek(xres_fd, 0, SEEK_SET); | ||
| rc = write(xres_fd, "0", 1); | ||
| /* XXX, should be correllated with LIFTOFF_TIMEOUT in ts driver */ | ||
| usleep(80000); | ||
| ts_state = 0; | ||
| } | ||
| } | ||
|
|
||
| void init_digitizer_fd(void) { | ||
| /* TS file descriptors. Ignore errors. */ | ||
| vdd_fd = open("/sys/devices/platform/cy8ctma395/vdd", O_WRONLY); | ||
| if (vdd_fd < 0) | ||
| printf("TScontrol: Cannot open vdd - %d", errno); | ||
| xres_fd = open("/sys/devices/platform/cy8ctma395/xres", O_WRONLY); | ||
| if (xres_fd < 0) | ||
| printf("TScontrol: Cannot open xres - %d", errno); | ||
| wake_fd = open("/sys/user_hw/pins/ctp/wake/level", O_WRONLY); | ||
| if (wake_fd < 0) | ||
| printf("TScontrol: Cannot open wake - %d", errno); | ||
| i2c_fd = open("/dev/i2c-5", O_RDWR); | ||
| if (i2c_fd < 0) | ||
| printf("TScontrol: Cannot open i2c dev - %d", errno); | ||
|
|
||
| } |
Oops, something went wrong.