Staging: hv: hv_mouse: delete mouse_vsc.c
Move the mouse_vsc.c file into hv_mouse_drv.c as it makes no sense to have two files here, as we don't have to worry about the "closed vs. open" split that this code was originally written for. Cc: Hank Janssen <hjanssen@microsoft.com> Cc: K. Y. Srinivasan <kys@microsoft.com> Cc: Haiyang Zhang <haiyangz@microsoft.com> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
This commit is contained in:
Greg Kroah-Hartman
parent
e1f1a0e682
commit
9dccaa63c7
|
|
@ -12,4 +12,4 @@ hv_storvsc-y := storvsc_drv.o storvsc.o
|
|||
hv_blkvsc-y := blkvsc_drv.o blkvsc.o
|
||||
hv_netvsc-y := netvsc_drv.o netvsc.o rndis_filter.o
|
||||
hv_utils-y := hv_util.o hv_kvp.o
|
||||
hv_mouse-objs := hv_mouse_drv.o mouse_vsc.o
|
||||
hv_mouse-objs := hv_mouse_drv.o
|
||||
|
|
|
|||
|
|
@ -27,6 +27,8 @@
|
|||
#include <linux/module.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/workqueue.h>
|
||||
#include <linux/sched.h>
|
||||
#include <linux/wait.h>
|
||||
#include <linux/input.h>
|
||||
#include <linux/hid.h>
|
||||
#include <linux/hiddev.h>
|
||||
|
|
@ -37,10 +39,727 @@
|
|||
#include "logging.h"
|
||||
#include "version_info.h"
|
||||
#include "vmbus.h"
|
||||
#include "vmbus_api.h"
|
||||
#include "mousevsc_api.h"
|
||||
#include "channel.h"
|
||||
#include "vmbus_packet_format.h"
|
||||
#include "vmbus_hid_protocol.h"
|
||||
|
||||
#define NBITS(x) (((x)/BITS_PER_LONG)+1)
|
||||
|
||||
enum pipe_prot_msg_type {
|
||||
PipeMessageInvalid = 0,
|
||||
PipeMessageData,
|
||||
PipeMessageMaximum
|
||||
};
|
||||
|
||||
|
||||
struct pipe_prt_msg {
|
||||
enum pipe_prot_msg_type PacketType;
|
||||
u32 DataSize;
|
||||
char Data[1];
|
||||
};
|
||||
|
||||
/*
|
||||
* Data types
|
||||
*/
|
||||
struct mousevsc_prt_msg {
|
||||
enum pipe_prot_msg_type PacketType;
|
||||
u32 DataSize;
|
||||
union {
|
||||
SYNTHHID_PROTOCOL_REQUEST Request;
|
||||
SYNTHHID_PROTOCOL_RESPONSE Response;
|
||||
SYNTHHID_DEVICE_INFO_ACK Ack;
|
||||
} u;
|
||||
};
|
||||
|
||||
/*
|
||||
* Represents an mousevsc device
|
||||
*/
|
||||
struct mousevsc_dev {
|
||||
struct hv_device *Device;
|
||||
/* 0 indicates the device is being destroyed */
|
||||
atomic_t RefCount;
|
||||
int NumOutstandingRequests;
|
||||
unsigned char bInitializeComplete;
|
||||
struct mousevsc_prt_msg ProtocolReq;
|
||||
struct mousevsc_prt_msg ProtocolResp;
|
||||
/* Synchronize the request/response if needed */
|
||||
wait_queue_head_t ProtocolWaitEvent;
|
||||
wait_queue_head_t DeviceInfoWaitEvent;
|
||||
int protocol_wait_condition;
|
||||
int device_wait_condition;
|
||||
int DeviceInfoStatus;
|
||||
|
||||
struct hid_descriptor *HidDesc;
|
||||
unsigned char *ReportDesc;
|
||||
u32 ReportDescSize;
|
||||
struct input_dev_info DeviceAttr;
|
||||
};
|
||||
|
||||
|
||||
/*
|
||||
* Globals
|
||||
*/
|
||||
static const char *gDriverName = "mousevsc";
|
||||
|
||||
/* {CFA8B69E-5B4A-4cc0-B98B-8BA1A1F3F95A} */
|
||||
static const struct hv_guid gMousevscDeviceType = {
|
||||
.data = {0x9E, 0xB6, 0xA8, 0xCF, 0x4A, 0x5B, 0xc0, 0x4c,
|
||||
0xB9, 0x8B, 0x8B, 0xA1, 0xA1, 0xF3, 0xF9, 0x5A}
|
||||
};
|
||||
|
||||
/*
|
||||
* Internal routines
|
||||
*/
|
||||
static int MousevscOnDeviceAdd(struct hv_device *Device, void *AdditionalInfo);
|
||||
|
||||
static int MousevscOnDeviceRemove(struct hv_device *Device);
|
||||
|
||||
static void MousevscOnCleanup(struct hv_driver *Device);
|
||||
|
||||
static void MousevscOnChannelCallback(void *Context);
|
||||
|
||||
static int MousevscConnectToVsp(struct hv_device *Device);
|
||||
|
||||
static void MousevscOnReceive(struct hv_device *Device,
|
||||
struct vmpacket_descriptor *Packet);
|
||||
|
||||
static inline struct mousevsc_dev *AllocInputDevice(struct hv_device *Device)
|
||||
{
|
||||
struct mousevsc_dev *inputDevice;
|
||||
|
||||
inputDevice = kzalloc(sizeof(struct mousevsc_dev), GFP_KERNEL);
|
||||
|
||||
if (!inputDevice)
|
||||
return NULL;
|
||||
|
||||
/*
|
||||
* Set to 2 to allow both inbound and outbound traffics
|
||||
* (ie GetInputDevice() and MustGetInputDevice()) to proceed.
|
||||
*/
|
||||
atomic_cmpxchg(&inputDevice->RefCount, 0, 2);
|
||||
|
||||
inputDevice->Device = Device;
|
||||
Device->ext = inputDevice;
|
||||
|
||||
return inputDevice;
|
||||
}
|
||||
|
||||
static inline void FreeInputDevice(struct mousevsc_dev *Device)
|
||||
{
|
||||
WARN_ON(atomic_read(&Device->RefCount) == 0);
|
||||
kfree(Device);
|
||||
}
|
||||
|
||||
/*
|
||||
* Get the inputdevice object if exists and its refcount > 1
|
||||
*/
|
||||
static inline struct mousevsc_dev *GetInputDevice(struct hv_device *Device)
|
||||
{
|
||||
struct mousevsc_dev *inputDevice;
|
||||
|
||||
inputDevice = (struct mousevsc_dev *)Device->ext;
|
||||
|
||||
/*
|
||||
* FIXME
|
||||
* This sure isn't a valid thing to print for debugging, no matter
|
||||
* what the intention is...
|
||||
*
|
||||
* printk(KERN_ERR "-------------------------> REFCOUNT = %d",
|
||||
* inputDevice->RefCount);
|
||||
*/
|
||||
|
||||
if (inputDevice && atomic_read(&inputDevice->RefCount) > 1)
|
||||
atomic_inc(&inputDevice->RefCount);
|
||||
else
|
||||
inputDevice = NULL;
|
||||
|
||||
return inputDevice;
|
||||
}
|
||||
|
||||
/*
|
||||
* Get the inputdevice object iff exists and its refcount > 0
|
||||
*/
|
||||
static inline struct mousevsc_dev *MustGetInputDevice(struct hv_device *Device)
|
||||
{
|
||||
struct mousevsc_dev *inputDevice;
|
||||
|
||||
inputDevice = (struct mousevsc_dev *)Device->ext;
|
||||
|
||||
if (inputDevice && atomic_read(&inputDevice->RefCount))
|
||||
atomic_inc(&inputDevice->RefCount);
|
||||
else
|
||||
inputDevice = NULL;
|
||||
|
||||
return inputDevice;
|
||||
}
|
||||
|
||||
static inline void PutInputDevice(struct hv_device *Device)
|
||||
{
|
||||
struct mousevsc_dev *inputDevice;
|
||||
|
||||
inputDevice = (struct mousevsc_dev *)Device->ext;
|
||||
|
||||
atomic_dec(&inputDevice->RefCount);
|
||||
}
|
||||
|
||||
/*
|
||||
* Drop ref count to 1 to effectively disable GetInputDevice()
|
||||
*/
|
||||
static inline struct mousevsc_dev *ReleaseInputDevice(struct hv_device *Device)
|
||||
{
|
||||
struct mousevsc_dev *inputDevice;
|
||||
|
||||
inputDevice = (struct mousevsc_dev *)Device->ext;
|
||||
|
||||
/* Busy wait until the ref drop to 2, then set it to 1 */
|
||||
while (atomic_cmpxchg(&inputDevice->RefCount, 2, 1) != 2)
|
||||
udelay(100);
|
||||
|
||||
return inputDevice;
|
||||
}
|
||||
|
||||
/*
|
||||
* Drop ref count to 0. No one can use InputDevice object.
|
||||
*/
|
||||
static inline struct mousevsc_dev *FinalReleaseInputDevice(struct hv_device *Device)
|
||||
{
|
||||
struct mousevsc_dev *inputDevice;
|
||||
|
||||
inputDevice = (struct mousevsc_dev *)Device->ext;
|
||||
|
||||
/* Busy wait until the ref drop to 1, then set it to 0 */
|
||||
while (atomic_cmpxchg(&inputDevice->RefCount, 1, 0) != 1)
|
||||
udelay(100);
|
||||
|
||||
Device->ext = NULL;
|
||||
return inputDevice;
|
||||
}
|
||||
|
||||
/*
|
||||
*
|
||||
* Name:
|
||||
* MousevscInitialize()
|
||||
*
|
||||
* Description:
|
||||
* Main entry point
|
||||
*
|
||||
*/
|
||||
int mouse_vsc_initialize(struct hv_driver *Driver)
|
||||
{
|
||||
struct mousevsc_drv_obj *inputDriver =
|
||||
(struct mousevsc_drv_obj *)Driver;
|
||||
int ret = 0;
|
||||
|
||||
Driver->name = gDriverName;
|
||||
memcpy(&Driver->dev_type, &gMousevscDeviceType,
|
||||
sizeof(struct hv_guid));
|
||||
|
||||
/* Setup the dispatch table */
|
||||
inputDriver->Base.dev_add = MousevscOnDeviceAdd;
|
||||
inputDriver->Base.dev_rm = MousevscOnDeviceRemove;
|
||||
inputDriver->Base.cleanup = MousevscOnCleanup;
|
||||
|
||||
inputDriver->OnOpen = NULL;
|
||||
inputDriver->OnClose = NULL;
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
/*
|
||||
*
|
||||
* Name:
|
||||
* MousevscOnDeviceAdd()
|
||||
*
|
||||
* Description:
|
||||
* Callback when the device belonging to this driver is added
|
||||
*
|
||||
*/
|
||||
int
|
||||
MousevscOnDeviceAdd(struct hv_device *Device, void *AdditionalInfo)
|
||||
{
|
||||
int ret = 0;
|
||||
struct mousevsc_dev *inputDevice;
|
||||
struct mousevsc_drv_obj *inputDriver;
|
||||
struct input_dev_info deviceInfo;
|
||||
|
||||
inputDevice = AllocInputDevice(Device);
|
||||
|
||||
if (!inputDevice) {
|
||||
ret = -1;
|
||||
goto Cleanup;
|
||||
}
|
||||
|
||||
inputDevice->bInitializeComplete = false;
|
||||
|
||||
/* Open the channel */
|
||||
ret = vmbus_open(Device->channel,
|
||||
INPUTVSC_SEND_RING_BUFFER_SIZE,
|
||||
INPUTVSC_RECV_RING_BUFFER_SIZE,
|
||||
NULL,
|
||||
0,
|
||||
MousevscOnChannelCallback,
|
||||
Device
|
||||
);
|
||||
|
||||
if (ret != 0) {
|
||||
pr_err("unable to open channel: %d", ret);
|
||||
return -1;
|
||||
}
|
||||
|
||||
pr_info("InputVsc channel open: %d", ret);
|
||||
|
||||
ret = MousevscConnectToVsp(Device);
|
||||
|
||||
if (ret != 0) {
|
||||
pr_err("unable to connect channel: %d", ret);
|
||||
|
||||
vmbus_close(Device->channel);
|
||||
return ret;
|
||||
}
|
||||
|
||||
inputDriver = (struct mousevsc_drv_obj *)inputDevice->Device->drv;
|
||||
|
||||
deviceInfo.VendorID = inputDevice->DeviceAttr.VendorID;
|
||||
deviceInfo.ProductID = inputDevice->DeviceAttr.ProductID;
|
||||
deviceInfo.VersionNumber = inputDevice->DeviceAttr.VersionNumber;
|
||||
strcpy(deviceInfo.Name, "Microsoft Vmbus HID-compliant Mouse");
|
||||
|
||||
/* Send the device info back up */
|
||||
inputDriver->OnDeviceInfo(Device, &deviceInfo);
|
||||
|
||||
/* Send the report desc back up */
|
||||
/* workaround SA-167 */
|
||||
if (inputDevice->ReportDesc[14] == 0x25)
|
||||
inputDevice->ReportDesc[14] = 0x29;
|
||||
|
||||
inputDriver->OnReportDescriptor(Device, inputDevice->ReportDesc, inputDevice->ReportDescSize);
|
||||
|
||||
inputDevice->bInitializeComplete = true;
|
||||
|
||||
Cleanup:
|
||||
return ret;
|
||||
}
|
||||
|
||||
int
|
||||
MousevscConnectToVsp(struct hv_device *Device)
|
||||
{
|
||||
int ret = 0;
|
||||
struct mousevsc_dev *inputDevice;
|
||||
struct mousevsc_prt_msg *request;
|
||||
struct mousevsc_prt_msg *response;
|
||||
|
||||
inputDevice = GetInputDevice(Device);
|
||||
|
||||
if (!inputDevice) {
|
||||
pr_err("unable to get input device...device being destroyed?");
|
||||
return -1;
|
||||
}
|
||||
|
||||
init_waitqueue_head(&inputDevice->ProtocolWaitEvent);
|
||||
init_waitqueue_head(&inputDevice->DeviceInfoWaitEvent);
|
||||
|
||||
request = &inputDevice->ProtocolReq;
|
||||
|
||||
/*
|
||||
* Now, initiate the vsc/vsp initialization protocol on the open channel
|
||||
*/
|
||||
memset(request, sizeof(struct mousevsc_prt_msg), 0);
|
||||
|
||||
request->PacketType = PipeMessageData;
|
||||
request->DataSize = sizeof(SYNTHHID_PROTOCOL_REQUEST);
|
||||
|
||||
request->u.Request.Header.Type = SynthHidProtocolRequest;
|
||||
request->u.Request.Header.Size = sizeof(unsigned long);
|
||||
request->u.Request.VersionRequested.AsDWord =
|
||||
SYNTHHID_INPUT_VERSION_DWORD;
|
||||
|
||||
pr_info("SYNTHHID_PROTOCOL_REQUEST...");
|
||||
|
||||
ret = vmbus_sendpacket(Device->channel, request,
|
||||
sizeof(struct pipe_prt_msg) -
|
||||
sizeof(unsigned char) +
|
||||
sizeof(SYNTHHID_PROTOCOL_REQUEST),
|
||||
(unsigned long)request,
|
||||
VM_PKT_DATA_INBAND,
|
||||
VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED);
|
||||
if (ret != 0) {
|
||||
pr_err("unable to send SYNTHHID_PROTOCOL_REQUEST");
|
||||
goto Cleanup;
|
||||
}
|
||||
|
||||
inputDevice->protocol_wait_condition = 0;
|
||||
wait_event_timeout(inputDevice->ProtocolWaitEvent, inputDevice->protocol_wait_condition, msecs_to_jiffies(1000));
|
||||
if (inputDevice->protocol_wait_condition == 0) {
|
||||
ret = -ETIMEDOUT;
|
||||
goto Cleanup;
|
||||
}
|
||||
|
||||
response = &inputDevice->ProtocolResp;
|
||||
|
||||
if (!response->u.Response.Approved) {
|
||||
pr_err("SYNTHHID_PROTOCOL_REQUEST failed (version %d)",
|
||||
SYNTHHID_INPUT_VERSION_DWORD);
|
||||
ret = -1;
|
||||
goto Cleanup;
|
||||
}
|
||||
|
||||
inputDevice->device_wait_condition = 0;
|
||||
wait_event_timeout(inputDevice->DeviceInfoWaitEvent, inputDevice->device_wait_condition, msecs_to_jiffies(1000));
|
||||
if (inputDevice->device_wait_condition == 0) {
|
||||
ret = -ETIMEDOUT;
|
||||
goto Cleanup;
|
||||
}
|
||||
|
||||
/*
|
||||
* We should have gotten the device attr, hid desc and report
|
||||
* desc at this point
|
||||
*/
|
||||
if (!inputDevice->DeviceInfoStatus)
|
||||
pr_info("**** input channel up and running!! ****");
|
||||
else
|
||||
ret = -1;
|
||||
|
||||
Cleanup:
|
||||
PutInputDevice(Device);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
*
|
||||
* Name:
|
||||
* MousevscOnDeviceRemove()
|
||||
*
|
||||
* Description:
|
||||
* Callback when the our device is being removed
|
||||
*
|
||||
*/
|
||||
int
|
||||
MousevscOnDeviceRemove(struct hv_device *Device)
|
||||
{
|
||||
struct mousevsc_dev *inputDevice;
|
||||
int ret = 0;
|
||||
|
||||
pr_info("disabling input device (%p)...",
|
||||
Device->ext);
|
||||
|
||||
inputDevice = ReleaseInputDevice(Device);
|
||||
|
||||
|
||||
/*
|
||||
* At this point, all outbound traffic should be disable. We only
|
||||
* allow inbound traffic (responses) to proceed
|
||||
*
|
||||
* so that outstanding requests can be completed.
|
||||
*/
|
||||
while (inputDevice->NumOutstandingRequests) {
|
||||
pr_info("waiting for %d requests to complete...", inputDevice->NumOutstandingRequests);
|
||||
|
||||
udelay(100);
|
||||
}
|
||||
|
||||
pr_info("removing input device (%p)...", Device->ext);
|
||||
|
||||
inputDevice = FinalReleaseInputDevice(Device);
|
||||
|
||||
pr_info("input device (%p) safe to remove", inputDevice);
|
||||
|
||||
/* Close the channel */
|
||||
vmbus_close(Device->channel);
|
||||
|
||||
FreeInputDevice(inputDevice);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
*
|
||||
* Name:
|
||||
* MousevscOnCleanup()
|
||||
*
|
||||
* Description:
|
||||
* Perform any cleanup when the driver is removed
|
||||
*/
|
||||
static void MousevscOnCleanup(struct hv_driver *drv)
|
||||
{
|
||||
}
|
||||
|
||||
|
||||
static void
|
||||
MousevscOnSendCompletion(struct hv_device *Device,
|
||||
struct vmpacket_descriptor *Packet)
|
||||
{
|
||||
struct mousevsc_dev *inputDevice;
|
||||
void *request;
|
||||
|
||||
inputDevice = MustGetInputDevice(Device);
|
||||
if (!inputDevice) {
|
||||
pr_err("unable to get input device...device being destroyed?");
|
||||
return;
|
||||
}
|
||||
|
||||
request = (void *)(unsigned long *)Packet->trans_id;
|
||||
|
||||
if (request == &inputDevice->ProtocolReq) {
|
||||
/* FIXME */
|
||||
/* Shouldn't we be doing something here? */
|
||||
}
|
||||
|
||||
PutInputDevice(Device);
|
||||
}
|
||||
|
||||
void
|
||||
MousevscOnReceiveDeviceInfo(
|
||||
struct mousevsc_dev *InputDevice,
|
||||
SYNTHHID_DEVICE_INFO *DeviceInfo)
|
||||
{
|
||||
int ret = 0;
|
||||
struct hid_descriptor *desc;
|
||||
struct mousevsc_prt_msg ack;
|
||||
|
||||
/* Assume success for now */
|
||||
InputDevice->DeviceInfoStatus = 0;
|
||||
|
||||
/* Save the device attr */
|
||||
memcpy(&InputDevice->DeviceAttr, &DeviceInfo->HidDeviceAttributes, sizeof(struct input_dev_info));
|
||||
|
||||
/* Save the hid desc */
|
||||
desc = (struct hid_descriptor *)DeviceInfo->HidDescriptorInformation;
|
||||
WARN_ON(desc->bLength > 0);
|
||||
|
||||
InputDevice->HidDesc = kzalloc(desc->bLength, GFP_KERNEL);
|
||||
|
||||
if (!InputDevice->HidDesc) {
|
||||
pr_err("unable to allocate hid descriptor - size %d", desc->bLength);
|
||||
goto Cleanup;
|
||||
}
|
||||
|
||||
memcpy(InputDevice->HidDesc, desc, desc->bLength);
|
||||
|
||||
/* Save the report desc */
|
||||
InputDevice->ReportDescSize = desc->desc[0].wDescriptorLength;
|
||||
InputDevice->ReportDesc = kzalloc(InputDevice->ReportDescSize,
|
||||
GFP_KERNEL);
|
||||
|
||||
if (!InputDevice->ReportDesc) {
|
||||
pr_err("unable to allocate report descriptor - size %d",
|
||||
InputDevice->ReportDescSize);
|
||||
goto Cleanup;
|
||||
}
|
||||
|
||||
memcpy(InputDevice->ReportDesc,
|
||||
((unsigned char *)desc) + desc->bLength,
|
||||
desc->desc[0].wDescriptorLength);
|
||||
|
||||
/* Send the ack */
|
||||
memset(&ack, sizeof(struct mousevsc_prt_msg), 0);
|
||||
|
||||
ack.PacketType = PipeMessageData;
|
||||
ack.DataSize = sizeof(SYNTHHID_DEVICE_INFO_ACK);
|
||||
|
||||
ack.u.Ack.Header.Type = SynthHidInitialDeviceInfoAck;
|
||||
ack.u.Ack.Header.Size = 1;
|
||||
ack.u.Ack.Reserved = 0;
|
||||
|
||||
ret = vmbus_sendpacket(InputDevice->Device->channel,
|
||||
&ack,
|
||||
sizeof(struct pipe_prt_msg) - sizeof(unsigned char) + sizeof(SYNTHHID_DEVICE_INFO_ACK),
|
||||
(unsigned long)&ack,
|
||||
VM_PKT_DATA_INBAND,
|
||||
VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED);
|
||||
if (ret != 0) {
|
||||
pr_err("unable to send SYNTHHID_DEVICE_INFO_ACK - ret %d",
|
||||
ret);
|
||||
goto Cleanup;
|
||||
}
|
||||
|
||||
InputDevice->device_wait_condition = 1;
|
||||
wake_up(&InputDevice->DeviceInfoWaitEvent);
|
||||
|
||||
return;
|
||||
|
||||
Cleanup:
|
||||
if (InputDevice->HidDesc) {
|
||||
kfree(InputDevice->HidDesc);
|
||||
InputDevice->HidDesc = NULL;
|
||||
}
|
||||
|
||||
if (InputDevice->ReportDesc) {
|
||||
kfree(InputDevice->ReportDesc);
|
||||
InputDevice->ReportDesc = NULL;
|
||||
}
|
||||
|
||||
InputDevice->DeviceInfoStatus = -1;
|
||||
InputDevice->device_wait_condition = 1;
|
||||
wake_up(&InputDevice->DeviceInfoWaitEvent);
|
||||
}
|
||||
|
||||
|
||||
void
|
||||
MousevscOnReceiveInputReport(
|
||||
struct mousevsc_dev *InputDevice,
|
||||
SYNTHHID_INPUT_REPORT *InputReport)
|
||||
{
|
||||
struct mousevsc_drv_obj *inputDriver;
|
||||
|
||||
if (!InputDevice->bInitializeComplete) {
|
||||
pr_info("Initialization incomplete...ignoring InputReport msg");
|
||||
return;
|
||||
}
|
||||
|
||||
inputDriver = (struct mousevsc_drv_obj *)InputDevice->Device->drv;
|
||||
|
||||
inputDriver->OnInputReport(InputDevice->Device,
|
||||
InputReport->ReportBuffer,
|
||||
InputReport->Header.Size);
|
||||
}
|
||||
|
||||
void
|
||||
MousevscOnReceive(struct hv_device *Device, struct vmpacket_descriptor *Packet)
|
||||
{
|
||||
struct pipe_prt_msg *pipeMsg;
|
||||
SYNTHHID_MESSAGE *hidMsg;
|
||||
struct mousevsc_dev *inputDevice;
|
||||
|
||||
inputDevice = MustGetInputDevice(Device);
|
||||
if (!inputDevice) {
|
||||
pr_err("unable to get input device...device being destroyed?");
|
||||
return;
|
||||
}
|
||||
|
||||
pipeMsg = (struct pipe_prt_msg *)((unsigned long)Packet + (Packet->offset8 << 3));
|
||||
|
||||
if (pipeMsg->PacketType != PipeMessageData) {
|
||||
pr_err("unknown pipe msg type - type %d len %d",
|
||||
pipeMsg->PacketType, pipeMsg->DataSize);
|
||||
PutInputDevice(Device);
|
||||
return ;
|
||||
}
|
||||
|
||||
hidMsg = (SYNTHHID_MESSAGE *)&pipeMsg->Data[0];
|
||||
|
||||
switch (hidMsg->Header.Type) {
|
||||
case SynthHidProtocolResponse:
|
||||
memcpy(&inputDevice->ProtocolResp, pipeMsg, pipeMsg->DataSize+sizeof(struct pipe_prt_msg) - sizeof(unsigned char));
|
||||
inputDevice->protocol_wait_condition = 1;
|
||||
wake_up(&inputDevice->ProtocolWaitEvent);
|
||||
break;
|
||||
|
||||
case SynthHidInitialDeviceInfo:
|
||||
WARN_ON(pipeMsg->DataSize >= sizeof(struct input_dev_info));
|
||||
|
||||
/*
|
||||
* Parse out the device info into device attr,
|
||||
* hid desc and report desc
|
||||
*/
|
||||
MousevscOnReceiveDeviceInfo(inputDevice,
|
||||
(SYNTHHID_DEVICE_INFO *)&pipeMsg->Data[0]);
|
||||
break;
|
||||
case SynthHidInputReport:
|
||||
MousevscOnReceiveInputReport(inputDevice,
|
||||
(SYNTHHID_INPUT_REPORT *)&pipeMsg->Data[0]);
|
||||
|
||||
break;
|
||||
default:
|
||||
pr_err("unsupported hid msg type - type %d len %d",
|
||||
hidMsg->Header.Type, hidMsg->Header.Size);
|
||||
break;
|
||||
}
|
||||
|
||||
PutInputDevice(Device);
|
||||
}
|
||||
|
||||
void MousevscOnChannelCallback(void *Context)
|
||||
{
|
||||
const int packetSize = 0x100;
|
||||
int ret = 0;
|
||||
struct hv_device *device = (struct hv_device *)Context;
|
||||
struct mousevsc_dev *inputDevice;
|
||||
|
||||
u32 bytesRecvd;
|
||||
u64 requestId;
|
||||
unsigned char packet[packetSize];
|
||||
struct vmpacket_descriptor *desc;
|
||||
unsigned char *buffer = packet;
|
||||
int bufferlen = packetSize;
|
||||
|
||||
inputDevice = MustGetInputDevice(device);
|
||||
|
||||
if (!inputDevice) {
|
||||
pr_err("unable to get input device...device being destroyed?");
|
||||
return;
|
||||
}
|
||||
|
||||
do {
|
||||
ret = vmbus_recvpacket_raw(device->channel, buffer, bufferlen, &bytesRecvd, &requestId);
|
||||
|
||||
if (ret == 0) {
|
||||
if (bytesRecvd > 0) {
|
||||
desc = (struct vmpacket_descriptor *)buffer;
|
||||
|
||||
switch (desc->type) {
|
||||
case VM_PKT_COMP:
|
||||
MousevscOnSendCompletion(device,
|
||||
desc);
|
||||
break;
|
||||
|
||||
case VM_PKT_DATA_INBAND:
|
||||
MousevscOnReceive(device, desc);
|
||||
break;
|
||||
|
||||
default:
|
||||
pr_err("unhandled packet type %d, tid %llx len %d\n",
|
||||
desc->type,
|
||||
requestId,
|
||||
bytesRecvd);
|
||||
break;
|
||||
}
|
||||
|
||||
/* reset */
|
||||
if (bufferlen > packetSize) {
|
||||
kfree(buffer);
|
||||
|
||||
buffer = packet;
|
||||
bufferlen = packetSize;
|
||||
}
|
||||
} else {
|
||||
/*
|
||||
* pr_debug("nothing else to read...");
|
||||
* reset
|
||||
*/
|
||||
if (bufferlen > packetSize) {
|
||||
kfree(buffer);
|
||||
|
||||
buffer = packet;
|
||||
bufferlen = packetSize;
|
||||
}
|
||||
break;
|
||||
}
|
||||
} else if (ret == -2) {
|
||||
/* Handle large packet */
|
||||
bufferlen = bytesRecvd;
|
||||
buffer = kzalloc(bytesRecvd, GFP_KERNEL);
|
||||
|
||||
if (buffer == NULL) {
|
||||
buffer = packet;
|
||||
bufferlen = packetSize;
|
||||
|
||||
/* Try again next time around */
|
||||
pr_err("unable to allocate buffer of size %d!",
|
||||
bytesRecvd);
|
||||
break;
|
||||
}
|
||||
}
|
||||
} while (1);
|
||||
|
||||
PutInputDevice(device);
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
/*
|
||||
* Data types
|
||||
|
|
|
|||
|
|
@ -1,759 +0,0 @@
|
|||
/*
|
||||
* Copyright 2009 Citrix Systems, Inc.
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
* For clarity, the licensor of this program does not intend that a
|
||||
* "derivative work" include code which compiles header information from
|
||||
* this program.
|
||||
*
|
||||
* This code has been modified from its original by
|
||||
* Hank Janssen <hjanssen@microsoft.com>
|
||||
*/
|
||||
#include <linux/init.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/workqueue.h>
|
||||
#include <linux/sched.h>
|
||||
#include <linux/wait.h>
|
||||
#include <linux/input.h>
|
||||
#include <linux/hid.h>
|
||||
#include <linux/hiddev.h>
|
||||
|
||||
#include "hv_api.h"
|
||||
#include "vmbus.h"
|
||||
#include "vmbus_api.h"
|
||||
#include "channel.h"
|
||||
#include "logging.h"
|
||||
|
||||
#include "mousevsc_api.h"
|
||||
#include "vmbus_packet_format.h"
|
||||
#include "vmbus_hid_protocol.h"
|
||||
|
||||
|
||||
enum pipe_prot_msg_type {
|
||||
PipeMessageInvalid = 0,
|
||||
PipeMessageData,
|
||||
PipeMessageMaximum
|
||||
};
|
||||
|
||||
|
||||
struct pipe_prt_msg {
|
||||
enum pipe_prot_msg_type PacketType;
|
||||
u32 DataSize;
|
||||
char Data[1];
|
||||
};
|
||||
|
||||
/*
|
||||
* Data types
|
||||
*/
|
||||
struct mousevsc_prt_msg {
|
||||
enum pipe_prot_msg_type PacketType;
|
||||
u32 DataSize;
|
||||
union {
|
||||
SYNTHHID_PROTOCOL_REQUEST Request;
|
||||
SYNTHHID_PROTOCOL_RESPONSE Response;
|
||||
SYNTHHID_DEVICE_INFO_ACK Ack;
|
||||
} u;
|
||||
};
|
||||
|
||||
/*
|
||||
* Represents an mousevsc device
|
||||
*/
|
||||
struct mousevsc_dev {
|
||||
struct hv_device *Device;
|
||||
/* 0 indicates the device is being destroyed */
|
||||
atomic_t RefCount;
|
||||
int NumOutstandingRequests;
|
||||
unsigned char bInitializeComplete;
|
||||
struct mousevsc_prt_msg ProtocolReq;
|
||||
struct mousevsc_prt_msg ProtocolResp;
|
||||
/* Synchronize the request/response if needed */
|
||||
wait_queue_head_t ProtocolWaitEvent;
|
||||
wait_queue_head_t DeviceInfoWaitEvent;
|
||||
int protocol_wait_condition;
|
||||
int device_wait_condition;
|
||||
int DeviceInfoStatus;
|
||||
|
||||
struct hid_descriptor *HidDesc;
|
||||
unsigned char *ReportDesc;
|
||||
u32 ReportDescSize;
|
||||
struct input_dev_info DeviceAttr;
|
||||
};
|
||||
|
||||
|
||||
/*
|
||||
* Globals
|
||||
*/
|
||||
static const char *gDriverName = "mousevsc";
|
||||
|
||||
/* {CFA8B69E-5B4A-4cc0-B98B-8BA1A1F3F95A} */
|
||||
static const struct hv_guid gMousevscDeviceType = {
|
||||
.data = {0x9E, 0xB6, 0xA8, 0xCF, 0x4A, 0x5B, 0xc0, 0x4c,
|
||||
0xB9, 0x8B, 0x8B, 0xA1, 0xA1, 0xF3, 0xF9, 0x5A}
|
||||
};
|
||||
|
||||
/*
|
||||
* Internal routines
|
||||
*/
|
||||
static int MousevscOnDeviceAdd(struct hv_device *Device, void *AdditionalInfo);
|
||||
|
||||
static int MousevscOnDeviceRemove(struct hv_device *Device);
|
||||
|
||||
static void MousevscOnCleanup(struct hv_driver *Device);
|
||||
|
||||
static void MousevscOnChannelCallback(void *Context);
|
||||
|
||||
static int MousevscConnectToVsp(struct hv_device *Device);
|
||||
|
||||
static void MousevscOnReceive(struct hv_device *Device,
|
||||
struct vmpacket_descriptor *Packet);
|
||||
|
||||
static inline struct mousevsc_dev *AllocInputDevice(struct hv_device *Device)
|
||||
{
|
||||
struct mousevsc_dev *inputDevice;
|
||||
|
||||
inputDevice = kzalloc(sizeof(struct mousevsc_dev), GFP_KERNEL);
|
||||
|
||||
if (!inputDevice)
|
||||
return NULL;
|
||||
|
||||
/*
|
||||
* Set to 2 to allow both inbound and outbound traffics
|
||||
* (ie GetInputDevice() and MustGetInputDevice()) to proceed.
|
||||
*/
|
||||
atomic_cmpxchg(&inputDevice->RefCount, 0, 2);
|
||||
|
||||
inputDevice->Device = Device;
|
||||
Device->ext = inputDevice;
|
||||
|
||||
return inputDevice;
|
||||
}
|
||||
|
||||
static inline void FreeInputDevice(struct mousevsc_dev *Device)
|
||||
{
|
||||
WARN_ON(atomic_read(&Device->RefCount) == 0);
|
||||
kfree(Device);
|
||||
}
|
||||
|
||||
/*
|
||||
* Get the inputdevice object if exists and its refcount > 1
|
||||
*/
|
||||
static inline struct mousevsc_dev *GetInputDevice(struct hv_device *Device)
|
||||
{
|
||||
struct mousevsc_dev *inputDevice;
|
||||
|
||||
inputDevice = (struct mousevsc_dev *)Device->ext;
|
||||
|
||||
/*
|
||||
* FIXME
|
||||
* This sure isn't a valid thing to print for debugging, no matter
|
||||
* what the intention is...
|
||||
*
|
||||
* printk(KERN_ERR "-------------------------> REFCOUNT = %d",
|
||||
* inputDevice->RefCount);
|
||||
*/
|
||||
|
||||
if (inputDevice && atomic_read(&inputDevice->RefCount) > 1)
|
||||
atomic_inc(&inputDevice->RefCount);
|
||||
else
|
||||
inputDevice = NULL;
|
||||
|
||||
return inputDevice;
|
||||
}
|
||||
|
||||
/*
|
||||
* Get the inputdevice object iff exists and its refcount > 0
|
||||
*/
|
||||
static inline struct mousevsc_dev *MustGetInputDevice(struct hv_device *Device)
|
||||
{
|
||||
struct mousevsc_dev *inputDevice;
|
||||
|
||||
inputDevice = (struct mousevsc_dev *)Device->ext;
|
||||
|
||||
if (inputDevice && atomic_read(&inputDevice->RefCount))
|
||||
atomic_inc(&inputDevice->RefCount);
|
||||
else
|
||||
inputDevice = NULL;
|
||||
|
||||
return inputDevice;
|
||||
}
|
||||
|
||||
static inline void PutInputDevice(struct hv_device *Device)
|
||||
{
|
||||
struct mousevsc_dev *inputDevice;
|
||||
|
||||
inputDevice = (struct mousevsc_dev *)Device->ext;
|
||||
|
||||
atomic_dec(&inputDevice->RefCount);
|
||||
}
|
||||
|
||||
/*
|
||||
* Drop ref count to 1 to effectively disable GetInputDevice()
|
||||
*/
|
||||
static inline struct mousevsc_dev *ReleaseInputDevice(struct hv_device *Device)
|
||||
{
|
||||
struct mousevsc_dev *inputDevice;
|
||||
|
||||
inputDevice = (struct mousevsc_dev *)Device->ext;
|
||||
|
||||
/* Busy wait until the ref drop to 2, then set it to 1 */
|
||||
while (atomic_cmpxchg(&inputDevice->RefCount, 2, 1) != 2)
|
||||
udelay(100);
|
||||
|
||||
return inputDevice;
|
||||
}
|
||||
|
||||
/*
|
||||
* Drop ref count to 0. No one can use InputDevice object.
|
||||
*/
|
||||
static inline struct mousevsc_dev *FinalReleaseInputDevice(struct hv_device *Device)
|
||||
{
|
||||
struct mousevsc_dev *inputDevice;
|
||||
|
||||
inputDevice = (struct mousevsc_dev *)Device->ext;
|
||||
|
||||
/* Busy wait until the ref drop to 1, then set it to 0 */
|
||||
while (atomic_cmpxchg(&inputDevice->RefCount, 1, 0) != 1)
|
||||
udelay(100);
|
||||
|
||||
Device->ext = NULL;
|
||||
return inputDevice;
|
||||
}
|
||||
|
||||
/*
|
||||
*
|
||||
* Name:
|
||||
* MousevscInitialize()
|
||||
*
|
||||
* Description:
|
||||
* Main entry point
|
||||
*
|
||||
*/
|
||||
int mouse_vsc_initialize(struct hv_driver *Driver)
|
||||
{
|
||||
struct mousevsc_drv_obj *inputDriver =
|
||||
(struct mousevsc_drv_obj *)Driver;
|
||||
int ret = 0;
|
||||
|
||||
Driver->name = gDriverName;
|
||||
memcpy(&Driver->dev_type, &gMousevscDeviceType,
|
||||
sizeof(struct hv_guid));
|
||||
|
||||
/* Setup the dispatch table */
|
||||
inputDriver->Base.dev_add = MousevscOnDeviceAdd;
|
||||
inputDriver->Base.dev_rm = MousevscOnDeviceRemove;
|
||||
inputDriver->Base.cleanup = MousevscOnCleanup;
|
||||
|
||||
inputDriver->OnOpen = NULL;
|
||||
inputDriver->OnClose = NULL;
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
/*
|
||||
*
|
||||
* Name:
|
||||
* MousevscOnDeviceAdd()
|
||||
*
|
||||
* Description:
|
||||
* Callback when the device belonging to this driver is added
|
||||
*
|
||||
*/
|
||||
int
|
||||
MousevscOnDeviceAdd(struct hv_device *Device, void *AdditionalInfo)
|
||||
{
|
||||
int ret = 0;
|
||||
struct mousevsc_dev *inputDevice;
|
||||
struct mousevsc_drv_obj *inputDriver;
|
||||
struct input_dev_info deviceInfo;
|
||||
|
||||
inputDevice = AllocInputDevice(Device);
|
||||
|
||||
if (!inputDevice) {
|
||||
ret = -1;
|
||||
goto Cleanup;
|
||||
}
|
||||
|
||||
inputDevice->bInitializeComplete = false;
|
||||
|
||||
/* Open the channel */
|
||||
ret = vmbus_open(Device->channel,
|
||||
INPUTVSC_SEND_RING_BUFFER_SIZE,
|
||||
INPUTVSC_RECV_RING_BUFFER_SIZE,
|
||||
NULL,
|
||||
0,
|
||||
MousevscOnChannelCallback,
|
||||
Device
|
||||
);
|
||||
|
||||
if (ret != 0) {
|
||||
pr_err("unable to open channel: %d", ret);
|
||||
return -1;
|
||||
}
|
||||
|
||||
pr_info("InputVsc channel open: %d", ret);
|
||||
|
||||
ret = MousevscConnectToVsp(Device);
|
||||
|
||||
if (ret != 0) {
|
||||
pr_err("unable to connect channel: %d", ret);
|
||||
|
||||
vmbus_close(Device->channel);
|
||||
return ret;
|
||||
}
|
||||
|
||||
inputDriver = (struct mousevsc_drv_obj *)inputDevice->Device->drv;
|
||||
|
||||
deviceInfo.VendorID = inputDevice->DeviceAttr.VendorID;
|
||||
deviceInfo.ProductID = inputDevice->DeviceAttr.ProductID;
|
||||
deviceInfo.VersionNumber = inputDevice->DeviceAttr.VersionNumber;
|
||||
strcpy(deviceInfo.Name, "Microsoft Vmbus HID-compliant Mouse");
|
||||
|
||||
/* Send the device info back up */
|
||||
inputDriver->OnDeviceInfo(Device, &deviceInfo);
|
||||
|
||||
/* Send the report desc back up */
|
||||
/* workaround SA-167 */
|
||||
if (inputDevice->ReportDesc[14] == 0x25)
|
||||
inputDevice->ReportDesc[14] = 0x29;
|
||||
|
||||
inputDriver->OnReportDescriptor(Device, inputDevice->ReportDesc, inputDevice->ReportDescSize);
|
||||
|
||||
inputDevice->bInitializeComplete = true;
|
||||
|
||||
Cleanup:
|
||||
return ret;
|
||||
}
|
||||
|
||||
int
|
||||
MousevscConnectToVsp(struct hv_device *Device)
|
||||
{
|
||||
int ret = 0;
|
||||
struct mousevsc_dev *inputDevice;
|
||||
struct mousevsc_prt_msg *request;
|
||||
struct mousevsc_prt_msg *response;
|
||||
|
||||
inputDevice = GetInputDevice(Device);
|
||||
|
||||
if (!inputDevice) {
|
||||
pr_err("unable to get input device...device being destroyed?");
|
||||
return -1;
|
||||
}
|
||||
|
||||
init_waitqueue_head(&inputDevice->ProtocolWaitEvent);
|
||||
init_waitqueue_head(&inputDevice->DeviceInfoWaitEvent);
|
||||
|
||||
request = &inputDevice->ProtocolReq;
|
||||
|
||||
/*
|
||||
* Now, initiate the vsc/vsp initialization protocol on the open channel
|
||||
*/
|
||||
memset(request, sizeof(struct mousevsc_prt_msg), 0);
|
||||
|
||||
request->PacketType = PipeMessageData;
|
||||
request->DataSize = sizeof(SYNTHHID_PROTOCOL_REQUEST);
|
||||
|
||||
request->u.Request.Header.Type = SynthHidProtocolRequest;
|
||||
request->u.Request.Header.Size = sizeof(unsigned long);
|
||||
request->u.Request.VersionRequested.AsDWord =
|
||||
SYNTHHID_INPUT_VERSION_DWORD;
|
||||
|
||||
pr_info("SYNTHHID_PROTOCOL_REQUEST...");
|
||||
|
||||
ret = vmbus_sendpacket(Device->channel, request,
|
||||
sizeof(struct pipe_prt_msg) -
|
||||
sizeof(unsigned char) +
|
||||
sizeof(SYNTHHID_PROTOCOL_REQUEST),
|
||||
(unsigned long)request,
|
||||
VM_PKT_DATA_INBAND,
|
||||
VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED);
|
||||
if (ret != 0) {
|
||||
pr_err("unable to send SYNTHHID_PROTOCOL_REQUEST");
|
||||
goto Cleanup;
|
||||
}
|
||||
|
||||
inputDevice->protocol_wait_condition = 0;
|
||||
wait_event_timeout(inputDevice->ProtocolWaitEvent, inputDevice->protocol_wait_condition, msecs_to_jiffies(1000));
|
||||
if (inputDevice->protocol_wait_condition == 0) {
|
||||
ret = -ETIMEDOUT;
|
||||
goto Cleanup;
|
||||
}
|
||||
|
||||
response = &inputDevice->ProtocolResp;
|
||||
|
||||
if (!response->u.Response.Approved) {
|
||||
pr_err("SYNTHHID_PROTOCOL_REQUEST failed (version %d)",
|
||||
SYNTHHID_INPUT_VERSION_DWORD);
|
||||
ret = -1;
|
||||
goto Cleanup;
|
||||
}
|
||||
|
||||
inputDevice->device_wait_condition = 0;
|
||||
wait_event_timeout(inputDevice->DeviceInfoWaitEvent, inputDevice->device_wait_condition, msecs_to_jiffies(1000));
|
||||
if (inputDevice->device_wait_condition == 0) {
|
||||
ret = -ETIMEDOUT;
|
||||
goto Cleanup;
|
||||
}
|
||||
|
||||
/*
|
||||
* We should have gotten the device attr, hid desc and report
|
||||
* desc at this point
|
||||
*/
|
||||
if (!inputDevice->DeviceInfoStatus)
|
||||
pr_info("**** input channel up and running!! ****");
|
||||
else
|
||||
ret = -1;
|
||||
|
||||
Cleanup:
|
||||
PutInputDevice(Device);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
*
|
||||
* Name:
|
||||
* MousevscOnDeviceRemove()
|
||||
*
|
||||
* Description:
|
||||
* Callback when the our device is being removed
|
||||
*
|
||||
*/
|
||||
int
|
||||
MousevscOnDeviceRemove(struct hv_device *Device)
|
||||
{
|
||||
struct mousevsc_dev *inputDevice;
|
||||
int ret = 0;
|
||||
|
||||
pr_info("disabling input device (%p)...",
|
||||
Device->ext);
|
||||
|
||||
inputDevice = ReleaseInputDevice(Device);
|
||||
|
||||
|
||||
/*
|
||||
* At this point, all outbound traffic should be disable. We only
|
||||
* allow inbound traffic (responses) to proceed
|
||||
*
|
||||
* so that outstanding requests can be completed.
|
||||
*/
|
||||
while (inputDevice->NumOutstandingRequests) {
|
||||
pr_info("waiting for %d requests to complete...", inputDevice->NumOutstandingRequests);
|
||||
|
||||
udelay(100);
|
||||
}
|
||||
|
||||
pr_info("removing input device (%p)...", Device->ext);
|
||||
|
||||
inputDevice = FinalReleaseInputDevice(Device);
|
||||
|
||||
pr_info("input device (%p) safe to remove", inputDevice);
|
||||
|
||||
/* Close the channel */
|
||||
vmbus_close(Device->channel);
|
||||
|
||||
FreeInputDevice(inputDevice);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
*
|
||||
* Name:
|
||||
* MousevscOnCleanup()
|
||||
*
|
||||
* Description:
|
||||
* Perform any cleanup when the driver is removed
|
||||
*/
|
||||
static void MousevscOnCleanup(struct hv_driver *drv)
|
||||
{
|
||||
}
|
||||
|
||||
|
||||
static void
|
||||
MousevscOnSendCompletion(struct hv_device *Device,
|
||||
struct vmpacket_descriptor *Packet)
|
||||
{
|
||||
struct mousevsc_dev *inputDevice;
|
||||
void *request;
|
||||
|
||||
inputDevice = MustGetInputDevice(Device);
|
||||
if (!inputDevice) {
|
||||
pr_err("unable to get input device...device being destroyed?");
|
||||
return;
|
||||
}
|
||||
|
||||
request = (void *)(unsigned long *)Packet->trans_id;
|
||||
|
||||
if (request == &inputDevice->ProtocolReq) {
|
||||
/* FIXME */
|
||||
/* Shouldn't we be doing something here? */
|
||||
}
|
||||
|
||||
PutInputDevice(Device);
|
||||
}
|
||||
|
||||
void
|
||||
MousevscOnReceiveDeviceInfo(
|
||||
struct mousevsc_dev *InputDevice,
|
||||
SYNTHHID_DEVICE_INFO *DeviceInfo)
|
||||
{
|
||||
int ret = 0;
|
||||
struct hid_descriptor *desc;
|
||||
struct mousevsc_prt_msg ack;
|
||||
|
||||
/* Assume success for now */
|
||||
InputDevice->DeviceInfoStatus = 0;
|
||||
|
||||
/* Save the device attr */
|
||||
memcpy(&InputDevice->DeviceAttr, &DeviceInfo->HidDeviceAttributes, sizeof(struct input_dev_info));
|
||||
|
||||
/* Save the hid desc */
|
||||
desc = (struct hid_descriptor *)DeviceInfo->HidDescriptorInformation;
|
||||
WARN_ON(desc->bLength > 0);
|
||||
|
||||
InputDevice->HidDesc = kzalloc(desc->bLength, GFP_KERNEL);
|
||||
|
||||
if (!InputDevice->HidDesc) {
|
||||
pr_err("unable to allocate hid descriptor - size %d", desc->bLength);
|
||||
goto Cleanup;
|
||||
}
|
||||
|
||||
memcpy(InputDevice->HidDesc, desc, desc->bLength);
|
||||
|
||||
/* Save the report desc */
|
||||
InputDevice->ReportDescSize = desc->desc[0].wDescriptorLength;
|
||||
InputDevice->ReportDesc = kzalloc(InputDevice->ReportDescSize,
|
||||
GFP_KERNEL);
|
||||
|
||||
if (!InputDevice->ReportDesc) {
|
||||
pr_err("unable to allocate report descriptor - size %d",
|
||||
InputDevice->ReportDescSize);
|
||||
goto Cleanup;
|
||||
}
|
||||
|
||||
memcpy(InputDevice->ReportDesc,
|
||||
((unsigned char *)desc) + desc->bLength,
|
||||
desc->desc[0].wDescriptorLength);
|
||||
|
||||
/* Send the ack */
|
||||
memset(&ack, sizeof(struct mousevsc_prt_msg), 0);
|
||||
|
||||
ack.PacketType = PipeMessageData;
|
||||
ack.DataSize = sizeof(SYNTHHID_DEVICE_INFO_ACK);
|
||||
|
||||
ack.u.Ack.Header.Type = SynthHidInitialDeviceInfoAck;
|
||||
ack.u.Ack.Header.Size = 1;
|
||||
ack.u.Ack.Reserved = 0;
|
||||
|
||||
ret = vmbus_sendpacket(InputDevice->Device->channel,
|
||||
&ack,
|
||||
sizeof(struct pipe_prt_msg) - sizeof(unsigned char) + sizeof(SYNTHHID_DEVICE_INFO_ACK),
|
||||
(unsigned long)&ack,
|
||||
VM_PKT_DATA_INBAND,
|
||||
VMBUS_DATA_PACKET_FLAG_COMPLETION_REQUESTED);
|
||||
if (ret != 0) {
|
||||
pr_err("unable to send SYNTHHID_DEVICE_INFO_ACK - ret %d",
|
||||
ret);
|
||||
goto Cleanup;
|
||||
}
|
||||
|
||||
InputDevice->device_wait_condition = 1;
|
||||
wake_up(&InputDevice->DeviceInfoWaitEvent);
|
||||
|
||||
return;
|
||||
|
||||
Cleanup:
|
||||
if (InputDevice->HidDesc) {
|
||||
kfree(InputDevice->HidDesc);
|
||||
InputDevice->HidDesc = NULL;
|
||||
}
|
||||
|
||||
if (InputDevice->ReportDesc) {
|
||||
kfree(InputDevice->ReportDesc);
|
||||
InputDevice->ReportDesc = NULL;
|
||||
}
|
||||
|
||||
InputDevice->DeviceInfoStatus = -1;
|
||||
InputDevice->device_wait_condition = 1;
|
||||
wake_up(&InputDevice->DeviceInfoWaitEvent);
|
||||
}
|
||||
|
||||
|
||||
void
|
||||
MousevscOnReceiveInputReport(
|
||||
struct mousevsc_dev *InputDevice,
|
||||
SYNTHHID_INPUT_REPORT *InputReport)
|
||||
{
|
||||
struct mousevsc_drv_obj *inputDriver;
|
||||
|
||||
if (!InputDevice->bInitializeComplete) {
|
||||
pr_info("Initialization incomplete...ignoring InputReport msg");
|
||||
return;
|
||||
}
|
||||
|
||||
inputDriver = (struct mousevsc_drv_obj *)InputDevice->Device->drv;
|
||||
|
||||
inputDriver->OnInputReport(InputDevice->Device,
|
||||
InputReport->ReportBuffer,
|
||||
InputReport->Header.Size);
|
||||
}
|
||||
|
||||
void
|
||||
MousevscOnReceive(struct hv_device *Device, struct vmpacket_descriptor *Packet)
|
||||
{
|
||||
struct pipe_prt_msg *pipeMsg;
|
||||
SYNTHHID_MESSAGE *hidMsg;
|
||||
struct mousevsc_dev *inputDevice;
|
||||
|
||||
inputDevice = MustGetInputDevice(Device);
|
||||
if (!inputDevice) {
|
||||
pr_err("unable to get input device...device being destroyed?");
|
||||
return;
|
||||
}
|
||||
|
||||
pipeMsg = (struct pipe_prt_msg *)((unsigned long)Packet + (Packet->offset8 << 3));
|
||||
|
||||
if (pipeMsg->PacketType != PipeMessageData) {
|
||||
pr_err("unknown pipe msg type - type %d len %d",
|
||||
pipeMsg->PacketType, pipeMsg->DataSize);
|
||||
PutInputDevice(Device);
|
||||
return ;
|
||||
}
|
||||
|
||||
hidMsg = (SYNTHHID_MESSAGE *)&pipeMsg->Data[0];
|
||||
|
||||
switch (hidMsg->Header.Type) {
|
||||
case SynthHidProtocolResponse:
|
||||
memcpy(&inputDevice->ProtocolResp, pipeMsg, pipeMsg->DataSize+sizeof(struct pipe_prt_msg) - sizeof(unsigned char));
|
||||
inputDevice->protocol_wait_condition = 1;
|
||||
wake_up(&inputDevice->ProtocolWaitEvent);
|
||||
break;
|
||||
|
||||
case SynthHidInitialDeviceInfo:
|
||||
WARN_ON(pipeMsg->DataSize >= sizeof(struct input_dev_info));
|
||||
|
||||
/*
|
||||
* Parse out the device info into device attr,
|
||||
* hid desc and report desc
|
||||
*/
|
||||
MousevscOnReceiveDeviceInfo(inputDevice,
|
||||
(SYNTHHID_DEVICE_INFO *)&pipeMsg->Data[0]);
|
||||
break;
|
||||
case SynthHidInputReport:
|
||||
MousevscOnReceiveInputReport(inputDevice,
|
||||
(SYNTHHID_INPUT_REPORT *)&pipeMsg->Data[0]);
|
||||
|
||||
break;
|
||||
default:
|
||||
pr_err("unsupported hid msg type - type %d len %d",
|
||||
hidMsg->Header.Type, hidMsg->Header.Size);
|
||||
break;
|
||||
}
|
||||
|
||||
PutInputDevice(Device);
|
||||
}
|
||||
|
||||
void MousevscOnChannelCallback(void *Context)
|
||||
{
|
||||
const int packetSize = 0x100;
|
||||
int ret = 0;
|
||||
struct hv_device *device = (struct hv_device *)Context;
|
||||
struct mousevsc_dev *inputDevice;
|
||||
|
||||
u32 bytesRecvd;
|
||||
u64 requestId;
|
||||
unsigned char packet[packetSize];
|
||||
struct vmpacket_descriptor *desc;
|
||||
unsigned char *buffer = packet;
|
||||
int bufferlen = packetSize;
|
||||
|
||||
inputDevice = MustGetInputDevice(device);
|
||||
|
||||
if (!inputDevice) {
|
||||
pr_err("unable to get input device...device being destroyed?");
|
||||
return;
|
||||
}
|
||||
|
||||
do {
|
||||
ret = vmbus_recvpacket_raw(device->channel, buffer, bufferlen, &bytesRecvd, &requestId);
|
||||
|
||||
if (ret == 0) {
|
||||
if (bytesRecvd > 0) {
|
||||
desc = (struct vmpacket_descriptor *)buffer;
|
||||
|
||||
switch (desc->type) {
|
||||
case VM_PKT_COMP:
|
||||
MousevscOnSendCompletion(device,
|
||||
desc);
|
||||
break;
|
||||
|
||||
case VM_PKT_DATA_INBAND:
|
||||
MousevscOnReceive(device, desc);
|
||||
break;
|
||||
|
||||
default:
|
||||
pr_err("unhandled packet type %d, tid %llx len %d\n",
|
||||
desc->type,
|
||||
requestId,
|
||||
bytesRecvd);
|
||||
break;
|
||||
}
|
||||
|
||||
/* reset */
|
||||
if (bufferlen > packetSize) {
|
||||
kfree(buffer);
|
||||
|
||||
buffer = packet;
|
||||
bufferlen = packetSize;
|
||||
}
|
||||
} else {
|
||||
/*
|
||||
* pr_debug("nothing else to read...");
|
||||
* reset
|
||||
*/
|
||||
if (bufferlen > packetSize) {
|
||||
kfree(buffer);
|
||||
|
||||
buffer = packet;
|
||||
bufferlen = packetSize;
|
||||
}
|
||||
break;
|
||||
}
|
||||
} else if (ret == -2) {
|
||||
/* Handle large packet */
|
||||
bufferlen = bytesRecvd;
|
||||
buffer = kzalloc(bytesRecvd, GFP_KERNEL);
|
||||
|
||||
if (buffer == NULL) {
|
||||
buffer = packet;
|
||||
bufferlen = packetSize;
|
||||
|
||||
/* Try again next time around */
|
||||
pr_err("unable to allocate buffer of size %d!",
|
||||
bytesRecvd);
|
||||
break;
|
||||
}
|
||||
}
|
||||
} while (1);
|
||||
|
||||
PutInputDevice(device);
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
Loading…
Reference in New Issue