A-Team_Digital_Solutions/android_kernel_motorola_sm6375
Watch
2
0
Fork
You've already forked android_kernel_motorola_sm6375
 0
mirror of https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git synced 2026-10-13 16:16:15 -04:00
Code Issues Projects Releases Packages Wiki Activity

muc_uart: add usb control

Browse source 
Add usb control message handling from the muc.  The
message will set the online power supply property.

Additionally, setting the online property will send
a usb control message back to the muc with the set
value.

Change-Id: If7ef2eecbf862cbad15fb339e52a8f8c30c4ae2a
Signed-off-by: Ryan Lattrel <ryanl@motorola.com>
Reviewed-on: https://gerrit.mot.com/1279106
SLTApproved: Slta Waiver
SME-Granted: SME Approvals Granted
Reviewed-by: Kenneth Kessler <kennykessler@motorola.com>
Reviewed-by: Curtis Porter <porterc@motorola.com>
Tested-by: Jira Key
Submit-Approved: Jira Key
This commit is contained in:
Ryan Lattrel 2018-12-05 16:25:15 -06:00
commit 0720b6ec84
2 changed files with 58 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

6
drivers/mmi_muc_uart/muc_protocol.h
View file

@ -44,6 +44,7 @@ struct mmi_uart_pb_hdr_t {
#define PACKETBUS_PROT_MSG 0x0002
#define POWER_STATUS 0x0003
#define POWER_CONTROL 0x0004
#define USB_CONTROL 0x0005
#define BOOT_MODE 0x0007
#define MUC_FW_VERSION 0x0008
#define MUC_SET_GPIO 0x0009
@ -77,6 +78,11 @@ struct power_control_t {
int32_t current_ua;
} __packed;
enum { USB_SECONDARY_DISABLE = 0, USB_SECONDARY_ENABLE };
struct usb_control_t {
uint8_t cmd;
} __packed;
struct power_status_t {
bool reverse_boost; /* PMI855 Output Enabled. */
bool dc_in; /* DC IN Enabled. */

52
drivers/mmi_muc_uart/muc_uart.c
View file

@ -116,6 +116,7 @@ struct mod_muc_data_t {
struct timer_list ack_timer;
struct timer_list sleep_req_timer;
atomic_t mod_attached;
atomic_t mod_online;
struct workqueue_struct *write_wq;
struct write_data *write_data_q;
int write_q_size;
@ -1040,6 +1041,22 @@ static int muc_uart_set_gpio(struct device *dev, int value)
return 0;
}
static int muc_uart_handle_usb_ctrl(struct mod_muc_data_t *mm_data,
struct usb_control_t *usb_ctrl_pkt)
{
if (!mm_data)
return 1;
if (usb_ctrl_pkt->cmd != USB_SECONDARY_DISABLE &&
usb_ctrl_pkt->cmd != USB_SECONDARY_ENABLE)
return 1;
atomic_set(&mm_data->mod_online, usb_ctrl_pkt->cmd);
power_supply_changed(mm_data->phone_psy);
return 0;
}
static void muc_uart_handle_message(struct mod_muc_data_t *mm_data,
struct mmi_uart_hdr_t *hdr,
uint8_t *payload,
@ -1139,6 +1156,14 @@ static void muc_uart_handle_message(struct mod_muc_data_t *mm_data,
}
break;
}
case USB_CONTROL: {
/* TODO nack if size is wrong ? */
if (payload_len == sizeof(struct usb_control_t))
muc_uart_handle_usb_ctrl(mm_data,
(struct usb_control_t *)payload);
muc_uart_send(mm_data, hdr->cmd|MSG_ACK_MASK, NULL, 0);
break;
}
default: {
if (hdr->cmd & MSG_ACK_MASK)
clear_wait_for_ack(mm_data);
@ -1440,6 +1465,7 @@ f_end:
static enum power_supply_property muc_uart_ps_props[] = {
POWER_SUPPLY_PROP_PRESENT,
POWER_SUPPLY_PROP_ONLINE,
};
static int muc_uart_get_property(struct power_supply *psy,
@ -1452,6 +1478,31 @@ static int muc_uart_get_property(struct power_supply *psy,
case POWER_SUPPLY_PROP_PRESENT:
val->intval = atomic_read(&mm_data->mod_attached);
break;
case POWER_SUPPLY_PROP_ONLINE:
val->intval = atomic_read(&mm_data->mod_online);
break;
default:
return -EINVAL;
}
return 0;
}
static int muc_uart_set_property(struct power_supply *psy,
enum power_supply_property psp,
const union power_supply_propval *val)
{
struct mod_muc_data_t *mm_data = power_supply_get_drvdata(psy);
struct usb_control_t usbctrl_pkt;
switch (psp) {
case POWER_SUPPLY_PROP_ONLINE: {
usbctrl_pkt.cmd = val->intval;
muc_uart_queue_send(mm_data,
USB_CONTROL,
(uint8_t *)&usbctrl_pkt,
sizeof(struct usb_control_t));
break;
}
default:
return -EINVAL;
}
@ -1462,6 +1513,7 @@ static const struct power_supply_desc phone_psy_desc = {
.name = "phone",
.type = POWER_SUPPLY_TYPE_USB,
.get_property = muc_uart_get_property,
.set_property = muc_uart_set_property,
.properties = muc_uart_ps_props,
.num_properties = ARRAY_SIZE(muc_uart_ps_props),
};