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
|
//Copyright (C) Microsoft Corporation, All Rights Reserved
//
//Abstract:
//
// This module contains the type definitions for the client
// driver's device callback class.
//
//Environment:
//
// Windows User-Mode Driver Framework (UMDF)
#pragma once
#include <windows.h>
#include <wdf.h>
#include <math.h>
#include "SensorsTrace.h"
#include <SensorsCx.h>
#include <SensorsUtils.h>
#include "HardwareSimulator.h"
#include <windows.devices.sensors.h>
#define SENSORV2_POOL_TAG_SDO 'sodS'
#define Sdo_Mininum_DataInterval (20) // 50Hz
#define Sdo_Default_DataInterval (200) // 5Hz
//
// Sensor Common Properties
//
typedef enum
{
SENSOR_PROPERTY_STATE = 0,
SENSOR_PROPERTY_MIN_INTERVAL,
SENSOR_PROPERTY_MAX_DATAFIELDSIZE,
SENSOR_PROPERTY_SENSOR_TYPE,
SENSOR_PROPERTIES_COUNT
} SENSOR_COMMON_PROPERTIES_INDEX;
//
// Sensor Enumeration Properties
//
typedef enum
{
SENSOR_TYPE_GUID = 0,
SENSOR_MANUFACTURER,
SENSOR_MODEL,
SENSOR_PERSISTENT_UNIQUEID,
SENSOR_ISPRIMARY,
SENSOR_ENUMERATION_PROPERTIES_COUNT
} SENSOR_ENUMERATION_PROPERTIES_INDEX;
//
// Supported Data Fields
//
typedef enum
{
SDO_DATA_TIMESTAMP = 0,
SDO_DATA_SIMPLEDEVICEORIENTATION,
SDO_DATA_COUNT
} SDO_DATA_INDEX;
//
// Simple Device Orientation Driver Class
//
typedef class _SdoDevice
{
private:
// Simulator
WDFOBJECT m_SimulatorInstance;
// WDF
WDFDEVICE m_FxDevice;
SENSOROBJECT m_SensorInstance;
WDFWAITLOCK m_Lock;
WDFTIMER m_Timer;
// Sensor operation
BOOLEAN m_PoweredOn;
BOOLEAN m_Started;
// Sensor Specific Properties
PSENSOR_PROPERTY_LIST m_pSupportedDataFields;
PSENSOR_COLLECTION_LIST m_pEnumerationProperties;
PSENSOR_COLLECTION_LIST m_pProperties;
PSENSOR_COLLECTION_LIST m_pEmptyThreshold;
//
// SDO Operation ----------------------------------------------------
//
ULONG m_Interval;
BOOLEAN m_FirstSample;
ULONG m_StartTime;
ULONGLONG m_SampleCount;
PSENSOR_COLLECTION_LIST m_pData; // Sdo data that is going to push to clx
ABI::Windows::Devices::Sensors::SimpleOrientation m_LastSample;
public:
// WDF callbacks
static EVT_WDF_DRIVER_DEVICE_ADD OnDeviceAdd;
static EVT_WDF_DEVICE_PREPARE_HARDWARE OnPrepareHardware;
static EVT_WDF_DEVICE_RELEASE_HARDWARE OnReleaseHardware;
static EVT_WDF_DEVICE_D0_ENTRY OnD0Entry;
static EVT_WDF_DEVICE_D0_EXIT OnD0Exit;
static EVT_WDF_TIMER OnTimerExpire;
// CLX callbacks
static EVT_SENSOR_DRIVER_START_SENSOR OnStart;
static EVT_SENSOR_DRIVER_STOP_SENSOR OnStop;
static EVT_SENSOR_DRIVER_GET_SUPPORTED_DATA_FIELDS OnGetSupportedDataFields;
static EVT_SENSOR_DRIVER_GET_PROPERTIES OnGetProperties;
static EVT_SENSOR_DRIVER_GET_DATA_FIELD_PROPERTIES OnGetDataFieldProperties;
static EVT_SENSOR_DRIVER_GET_DATA_INTERVAL OnGetDataInterval;
static EVT_SENSOR_DRIVER_SET_DATA_INTERVAL OnSetDataInterval;
static EVT_SENSOR_DRIVER_GET_DATA_THRESHOLDS OnGetDataThresholds;
static EVT_SENSOR_DRIVER_SET_DATA_THRESHOLDS OnSetDataThresholds;
static EVT_SENSOR_DRIVER_DEVICE_IO_CONTROL OnIoControl;
private:
NTSTATUS Initialize(_In_ WDFDEVICE Device, _In_ SENSOROBJECT SensorObj);
NTSTATUS GetData();
} SdoDevice, *PSdoDevice;
//
// Set up accessor function to retrieve device context
//
WDF_DECLARE_CONTEXT_TYPE_WITH_NAME(SdoDevice, GetSdoContextFromSensorInstance);
|