1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
|
/* Copyright 2021 The ChromiumOS Authors
* Use of this source code is governed by a BSD-style license that can be
* found in the LICENSE file.
*/
#include <stddef.h>
#include <string.h>
#include "cbi_ssfc.h"
#include "gpio.h"
#include "hooks.h"
#include "keyboard_8042.h"
#include "ps2.h"
#include "ps2_chip.h"
#include "registers.h"
#include "time.h"
#define PS2_TRANSMIT_DELAY_MS 10
static uint8_t queue_data[3];
static int data_count;
void send_aux_data_to_device(uint8_t data)
{
ps2_transmit_byte(PRIMUS_PS2_CH, data);
}
static void board_init(void)
{
ps2_enable_channel(PRIMUS_PS2_CH, 1, send_aux_data_to_host_interrupt);
}
DECLARE_HOOK(HOOK_INIT, board_init, HOOK_PRIO_DEFAULT);
/*
* Goodix touchpad AVDD need to pull low to 0V when poweroff.
* Setting PS2 module in GPIO.inc will let AVDD have 0.9V offset.
* So we need to enable PS2 module later than PLTRST# to avoid the 0.9V
* offset.
*/
static void enable_ps2(void)
{
gpio_set_alternate_function(GPIO_PORT_6, BIT(2) | BIT(3),
GPIO_ALT_FUNC_DEFAULT);
}
DECLARE_DEFERRED(enable_ps2);
static void disable_ps2(void)
{
gpio_set_flags(GPIO_EC_PS2_SCL_TPAD, GPIO_ODR_LOW);
gpio_set_flags(GPIO_EC_PS2_SDA_TPAD, GPIO_ODR_LOW);
gpio_set_alternate_function(GPIO_PORT_6, BIT(2) | BIT(3),
GPIO_ALT_FUNC_NONE);
/* make sure PLTRST# goes high and re-enable PS2.*/
hook_call_deferred(&enable_ps2_data, 2 * SECOND);
}
DECLARE_HOOK(HOOK_CHIPSET_RESET, disable_ps2, HOOK_PRIO_DEFAULT);
static void ps2_transmit(uint8_t cmd)
{
ps2_transmit_byte(PRIMUS_PS2_CH, cmd);
msleep(PS2_TRANSMIT_DELAY_MS);
}
/* Process the PS2 data at here */
void get_ps2_data(uint8_t data)
{
/* receive the PS2 data and save in PS2 queue */
queue_data[data_count++] = data;
}
static void send_command_to_trackpoint(uint8_t command1, uint8_t command2)
{
/*
* Send command to trackpoint and wait,
* this will make sure EC get ACK from PS2 device
* and send the next command.
*/
ps2_transmit(TP_COMMAND);
ps2_transmit(TP_TOGGLE);
ps2_transmit(command1);
ps2_transmit(command2);
}
uint8_t get_trackpoint_id(void)
{
/*
* Three data will be received when asking PS2
* device id.
*/
ps2_transmit(TP_READ_ID);
/*
* When EC send TP_READ_ID, trackpoint will return ACK(0xFA),
* and then return device ID. So return the second data.
* Also make sure only return the trackpoint device ID.
*/
if (queue_data[1] == TP_VARIANT_ELAN ||
queue_data[1] == TP_VARIANT_SYNAPTICS)
return queue_data[1];
else
return 0;
}
/* Called on AP S0 -> S0ix transition */
static void ps2_suspend(void)
{
uint8_t trackpoint_id;
/*
* When EC send PS2 command to PS2 device,
* PS2 device will return ACK(0xFA).
* EC will send it to host and cause host wake from suspend.
* So disable EC send data to host to avoid it.
*
* In order to receive the PS2 data and also not to wake host,
* use get_ps2_data to process PS2 data.
*/
ps2_enable_channel(PRIMUS_PS2_CH, 1, get_ps2_data);
trackpoint_id = get_trackpoint_id();
/*
* Don't need to read any data from PS2 device now,
* so disable it.
*/
ps2_enable_channel(PRIMUS_PS2_CH, 1, NULL);
/*
* Send suspend mode to trackpoint
* Those commands was provide by Elan and Synaptics
*/
if (trackpoint_id == TP_VARIANT_ELAN)
send_command_to_trackpoint(TP_TOGGLE_BURST,
TP_TOGGLE_ELAN_SLEEP);
else if (trackpoint_id == TP_VARIANT_SYNAPTICS)
send_command_to_trackpoint(TP_TOGGLE_SOURCE_TAG,
TP_TOGGLE_SNAPTICS_SLEEP);
/* Clear the data in queue and the counter */
memset(queue_data, 0, ARRAY_SIZE(queue_data));
data_count = 0;
}
DECLARE_HOOK(HOOK_CHIPSET_SUSPEND, ps2_suspend, HOOK_PRIO_DEFAULT);
/* Called on AP S0ix -> S0 transition */
static void ps2_resume(void)
{
uint8_t trackpoint_id;
ps2_enable_channel(PRIMUS_PS2_CH, 1, get_ps2_data);
trackpoint_id = get_trackpoint_id();
ps2_enable_channel(PRIMUS_PS2_CH, 1, send_aux_data_to_host_interrupt);
/*
* For Synaptics trackpoint, EC need to send command to it again.
* For Elan trackpoint, we just need to touch trackpoint and it wake.
*/
if (trackpoint_id == TP_VARIANT_SYNAPTICS)
send_command_to_trackpoint(TP_TOGGLE_SOURCE_TAG,
TP_TOGGLE_SNAPTICS_SLEEP);
/* Clear the data in queue and the counter */
memset(queue_data, 0, ARRAY_SIZE(queue_data));
data_count = 0;
}
DECLARE_HOOK(HOOK_CHIPSET_RESUME, ps2_resume, HOOK_PRIO_DEFAULT);
|
