mirror of
https://github.com/Telecominfraproject/OpenCellular.git
synced 2026-01-10 01:21:49 +00:00
Modified TCPC layer to utilize the Power_Status and Power_Status_Mask registers. VBUS status is stored in Power_Status and when a change is detected, it's communicated to the TCPM via the ALERT# line. BUG=chrome-os-partner:43440 BRANCH=none TEST=Tested the feature on Glados and Oak connecting to both Ziger and Samus. Verfied that VBUS status is communicated via the TCPCI and that PD contracts are established without using the VBUS_WAKE GPIO lines on Glados and Oak. Change-Id: Ie5aa32eecc887f3cb00880a285f1e710b7064384 Signed-off-by: Scott Collyer <scollyer@chromium.org> Reviewed-on: https://chromium-review.googlesource.com/289931 Reviewed-by: Rong Chang <rongchang@chromium.org> Reviewed-by: Alec Berg <alecaberg@chromium.org> Commit-Queue: Rong Chang <rongchang@chromium.org> Tested-by: Rong Chang <rongchang@chromium.org>
297 lines
7.5 KiB
C
297 lines
7.5 KiB
C
/* Copyright 2015 The Chromium OS Authors. All rights reserved.
|
|
* Use of this source code is governed by a BSD-style license that can be
|
|
* found in the LICENSE file.
|
|
*/
|
|
|
|
/* Type-C port manager */
|
|
|
|
#include "i2c.h"
|
|
#include "task.h"
|
|
#include "tcpci.h"
|
|
#include "timer.h"
|
|
#include "usb_charge.h"
|
|
#include "usb_pd.h"
|
|
#include "usb_pd_tcpc.h"
|
|
#include "usb_pd_tcpm.h"
|
|
#include "util.h"
|
|
|
|
/* Convert port number to tcpc i2c address */
|
|
#define I2C_ADDR_TCPC(p) (CONFIG_TCPC_I2C_BASE_ADDR + 2*(p))
|
|
|
|
static int tcpc_polarity, tcpc_vconn, tcpc_vbus[CONFIG_USB_PD_PORT_COUNT];
|
|
|
|
static int init_alert_mask(int port)
|
|
{
|
|
uint16_t mask;
|
|
int rv;
|
|
|
|
/*
|
|
* Create mask of alert events that will cause the TCPC to
|
|
* signal the TCPM via the Alert# gpio line.
|
|
*/
|
|
mask = TCPC_REG_ALERT_TX_SUCCESS | TCPC_REG_ALERT_TX_FAILED |
|
|
TCPC_REG_ALERT_TX_DISCARDED | TCPC_REG_ALERT_RX_STATUS |
|
|
TCPC_REG_ALERT_RX_HARD_RST | TCPC_REG_ALERT_CC_STATUS
|
|
#ifdef CONFIG_USB_PD_TCPM_VBUS
|
|
| TCPC_REG_ALERT_POWER_STATUS
|
|
#endif
|
|
;
|
|
/* Set the alert mask in TCPC */
|
|
rv = tcpm_alert_mask_set(port, mask);
|
|
|
|
return rv;
|
|
}
|
|
|
|
#ifdef CONFIG_USB_PD_TCPM_VBUS
|
|
static int init_power_status_mask(int port)
|
|
{
|
|
uint8_t mask;
|
|
int rv;
|
|
|
|
mask = TCPC_REG_POWER_VBUS_PRES;
|
|
rv = tcpm_set_power_status_mask(port, mask);
|
|
|
|
return rv;
|
|
}
|
|
#endif
|
|
|
|
int tcpm_init(int port)
|
|
{
|
|
int rv, err = 0;
|
|
|
|
while (1) {
|
|
rv = i2c_read16(I2C_PORT_TCPC, I2C_ADDR_TCPC(port),
|
|
TCPC_REG_ERROR_STATUS, &err);
|
|
/*
|
|
* If i2c succeeds and the uninitialized bit is clear, then
|
|
* initalization is complete, clear all alert bits and write
|
|
* the initial alert mask.
|
|
*/
|
|
if (rv == EC_SUCCESS && !(err & TCPC_REG_ERROR_STATUS_UNINIT)) {
|
|
i2c_write16(I2C_PORT_TCPC, I2C_ADDR_TCPC(port),
|
|
TCPC_REG_ALERT, 0xff);
|
|
#ifdef CONFIG_USB_PD_TCPM_VBUS
|
|
/* Initialize power_status_mask */
|
|
init_power_status_mask(port);
|
|
#endif
|
|
return init_alert_mask(port);
|
|
}
|
|
msleep(10);
|
|
}
|
|
}
|
|
|
|
int tcpm_get_cc(int port, int *cc1, int *cc2)
|
|
{
|
|
int status;
|
|
int rv;
|
|
|
|
rv = i2c_read8(I2C_PORT_TCPC, I2C_ADDR_TCPC(port),
|
|
TCPC_REG_CC_STATUS, &status);
|
|
|
|
/* If i2c read fails, return error */
|
|
if (rv)
|
|
return rv;
|
|
|
|
*cc1 = TCPC_REG_CC_STATUS_CC1(status);
|
|
*cc2 = TCPC_REG_CC_STATUS_CC2(status);
|
|
|
|
/*
|
|
* If status is not open, then OR in termination to convert to
|
|
* enum tcpc_cc_voltage_status.
|
|
*/
|
|
if (*cc1 != TYPEC_CC_VOLT_OPEN)
|
|
*cc1 |= TCPC_REG_CC_STATUS_TERM(status) << 2;
|
|
if (*cc2 != TYPEC_CC_VOLT_OPEN)
|
|
*cc2 |= TCPC_REG_CC_STATUS_TERM(status) << 2;
|
|
|
|
return rv;
|
|
}
|
|
|
|
int tcpm_get_power_status(int port, int *status)
|
|
{
|
|
return i2c_read8(I2C_PORT_TCPC, I2C_ADDR_TCPC(port),
|
|
TCPC_REG_POWER_STATUS, status);
|
|
}
|
|
|
|
int tcpm_set_cc(int port, int pull)
|
|
{
|
|
/*
|
|
* Set manual control of Rp/Rd, and set both CC lines to the same
|
|
* pull.
|
|
*/
|
|
/* TODO: set desired Rp strength */
|
|
return i2c_write8(I2C_PORT_TCPC, I2C_ADDR_TCPC(port),
|
|
TCPC_REG_ROLE_CTRL,
|
|
TCPC_REG_ROLE_CTRL_SET(0, 0, pull, pull));
|
|
}
|
|
|
|
int tcpm_set_polarity(int port, int polarity)
|
|
{
|
|
/* Write new polarity, leave vconn enable flag untouched */
|
|
tcpc_polarity = polarity;
|
|
return i2c_write8(I2C_PORT_TCPC, I2C_ADDR_TCPC(port),
|
|
TCPC_REG_POWER_CTRL,
|
|
TCPC_REG_POWER_CTRL_SET(tcpc_polarity, tcpc_vconn));
|
|
}
|
|
|
|
int tcpm_set_vconn(int port, int enable)
|
|
{
|
|
/* Write new vconn enable flag, leave polarity untouched */
|
|
tcpc_vconn = enable;
|
|
return i2c_write8(I2C_PORT_TCPC, I2C_ADDR_TCPC(port),
|
|
TCPC_REG_POWER_CTRL,
|
|
TCPC_REG_POWER_CTRL_SET(tcpc_polarity, tcpc_vconn));
|
|
}
|
|
|
|
int tcpm_set_msg_header(int port, int power_role, int data_role)
|
|
{
|
|
return i2c_write8(I2C_PORT_TCPC, I2C_ADDR_TCPC(port),
|
|
TCPC_REG_MSG_HDR_INFO,
|
|
TCPC_REG_MSG_HDR_INFO_SET(data_role, power_role));
|
|
}
|
|
|
|
int tcpm_alert_status(int port, int *alert)
|
|
{
|
|
/* Read TCPC Alert register */
|
|
return i2c_read16(I2C_PORT_TCPC, I2C_ADDR_TCPC(port),
|
|
TCPC_REG_ALERT, alert);
|
|
}
|
|
|
|
int tcpm_set_rx_enable(int port, int enable)
|
|
{
|
|
/* If enable, then set RX detect for SOP and HRST */
|
|
return i2c_write8(I2C_PORT_TCPC, I2C_ADDR_TCPC(port),
|
|
TCPC_REG_RX_DETECT,
|
|
enable ? TCPC_REG_RX_DETECT_SOP_HRST_MASK : 0);
|
|
}
|
|
|
|
int tcpm_set_power_status_mask(int port, uint8_t mask)
|
|
{
|
|
/* write to the Alert Mask register */
|
|
return i2c_write8(I2C_PORT_TCPC, I2C_ADDR_TCPC(port),
|
|
TCPC_REG_POWER_STATUS_MASK , mask);
|
|
}
|
|
|
|
int tcpm_alert_mask_set(int port, uint16_t mask)
|
|
{
|
|
/* write to the Alert Mask register */
|
|
return i2c_write16(I2C_PORT_TCPC, I2C_ADDR_TCPC(port),
|
|
TCPC_REG_ALERT_MASK, mask);
|
|
}
|
|
|
|
#ifdef CONFIG_USB_PD_TCPM_VBUS
|
|
int tcpm_get_vbus_level(int port)
|
|
{
|
|
return tcpc_vbus[port];
|
|
}
|
|
#endif
|
|
|
|
int tcpm_get_message(int port, uint32_t *payload, int *head)
|
|
{
|
|
int rv, cnt, reg = TCPC_REG_RX_DATA;
|
|
|
|
rv = i2c_read8(I2C_PORT_TCPC, I2C_ADDR_TCPC(port),
|
|
TCPC_REG_RX_BYTE_CNT, &cnt);
|
|
|
|
rv |= i2c_read16(I2C_PORT_TCPC, I2C_ADDR_TCPC(port),
|
|
TCPC_REG_RX_HDR, (int *)head);
|
|
|
|
if (rv == EC_SUCCESS && cnt > 0) {
|
|
i2c_lock(I2C_PORT_TCPC, 1);
|
|
rv = i2c_xfer(I2C_PORT_TCPC, I2C_ADDR_TCPC(port),
|
|
(uint8_t *)®, 1, (uint8_t *)payload,
|
|
cnt, I2C_XFER_SINGLE);
|
|
i2c_lock(I2C_PORT_TCPC, 0);
|
|
}
|
|
|
|
/* Read complete, clear RX status alert bit */
|
|
i2c_write16(I2C_PORT_TCPC, I2C_ADDR_TCPC(port),
|
|
TCPC_REG_ALERT, TCPC_REG_ALERT_RX_STATUS);
|
|
|
|
return rv;
|
|
}
|
|
|
|
int tcpm_transmit(int port, enum tcpm_transmit_type type, uint16_t header,
|
|
const uint32_t *data)
|
|
{
|
|
int reg = TCPC_REG_TX_DATA;
|
|
int rv, cnt = 4*PD_HEADER_CNT(header);
|
|
|
|
rv = i2c_write8(I2C_PORT_TCPC, I2C_ADDR_TCPC(port),
|
|
TCPC_REG_TX_BYTE_CNT, cnt);
|
|
|
|
rv |= i2c_write16(I2C_PORT_TCPC, I2C_ADDR_TCPC(port),
|
|
TCPC_REG_TX_HDR, header);
|
|
|
|
/* If i2c read fails, return error */
|
|
if (rv)
|
|
return rv;
|
|
|
|
if (cnt > 0) {
|
|
i2c_lock(I2C_PORT_TCPC, 1);
|
|
rv = i2c_xfer(I2C_PORT_TCPC, I2C_ADDR_TCPC(port),
|
|
(uint8_t *)®, 1, NULL, 0, I2C_XFER_START);
|
|
rv |= i2c_xfer(I2C_PORT_TCPC, I2C_ADDR_TCPC(port),
|
|
(uint8_t *)data, cnt, NULL, 0, I2C_XFER_STOP);
|
|
i2c_lock(I2C_PORT_TCPC, 0);
|
|
}
|
|
|
|
/* If i2c read fails, return error */
|
|
if (rv)
|
|
return rv;
|
|
|
|
rv = i2c_write8(I2C_PORT_TCPC, I2C_ADDR_TCPC(port),
|
|
TCPC_REG_TRANSMIT, TCPC_REG_TRANSMIT_SET(type));
|
|
|
|
return rv;
|
|
}
|
|
|
|
void tcpc_alert(int port)
|
|
{
|
|
int status;
|
|
int power_status;
|
|
|
|
/* Read the Alert register from the TCPC */
|
|
tcpm_alert_status(port, &status);
|
|
|
|
/*
|
|
* Clear alert status for everything except RX_STATUS, which shouldn't
|
|
* be cleared until we have successfully retrieved message.
|
|
*/
|
|
if (status & ~TCPC_REG_ALERT_RX_STATUS)
|
|
i2c_write16(I2C_PORT_TCPC, I2C_ADDR_TCPC(port),
|
|
TCPC_REG_ALERT, status & ~TCPC_REG_ALERT_RX_STATUS);
|
|
|
|
if (status & TCPC_REG_ALERT_CC_STATUS) {
|
|
/* CC status changed, wake task */
|
|
task_set_event(PD_PORT_TO_TASK_ID(port), PD_EVENT_CC, 0);
|
|
}
|
|
if (status & TCPC_REG_ALERT_POWER_STATUS) {
|
|
/* Read Power Status register */
|
|
tcpm_get_power_status(port, &power_status);
|
|
/* Update VBUS status */
|
|
tcpc_vbus[port] = power_status &
|
|
TCPC_REG_POWER_VBUS_PRES ? 1 : 0;
|
|
#if defined(CONFIG_USB_PD_TCPM_VBUS) && defined(CONFIG_USB_CHARGER)
|
|
/* Update charge manager with new VBUS state */
|
|
usb_charger_vbus_change(port, tcpc_vbus[port]);
|
|
#endif /* CONFIG_USB_PD_TCPM_VBUS && CONFIG_USB_CHARGER */
|
|
task_wake(PD_PORT_TO_TASK_ID(port));
|
|
}
|
|
if (status & TCPC_REG_ALERT_RX_STATUS) {
|
|
/* message received */
|
|
task_set_event(PD_PORT_TO_TASK_ID(port), PD_EVENT_RX, 0);
|
|
}
|
|
if (status & TCPC_REG_ALERT_RX_HARD_RST) {
|
|
/* hard reset received */
|
|
pd_execute_hard_reset(port);
|
|
task_wake(PD_PORT_TO_TASK_ID(port));
|
|
}
|
|
if (status & TCPC_REG_ALERT_TX_COMPLETE) {
|
|
/* transmit complete */
|
|
pd_transmit_complete(port, status & TCPC_REG_ALERT_TX_SUCCESS ?
|
|
TCPC_TX_COMPLETE_SUCCESS :
|
|
TCPC_TX_COMPLETE_FAILED);
|
|
}
|
|
}
|