スマートコンセント(富士通 FX-5204PS)をIEEE1888 StorageにWRITEするサンプルプログラムです。
Dependencies: EthernetInterface FiapV2 HTTPClientForSOAP NTPClient TextLCD mbed-rtos mbed spxml
Fork of BlueUSB_f by
スマートコンセント(富士通 FX-5204PS)をIEEE1888 StorageにWRITEするサンプルプログラムです。
USB HUBを使用して2台利用した例です。
表示のみは http://mbed.org/users/yueee_yt/code/BlueUSB_f/で公開しています。
BlueUSBより派生していますが、BluetoothとMass Storage Classは利用できません。
2台まで確認していますが、プログラム的には10台まで接続できるようにしています。
(RTOSとの整合により難しいかもしれません)
usps.cpp@1:3f2890d103fb, 2012-09-26 (annotated)
- Committer:
- yueee_yt
- Date:
- Wed Sep 26 06:29:47 2012 +0000
- Revision:
- 1:3f2890d103fb
- Child:
- 2:32a2d06f4fe2
Initial Version
;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
yueee_yt | 1:3f2890d103fb | 1 | #include "mbed.h" |
yueee_yt | 1:3f2890d103fb | 2 | #include "USBHost.h" |
yueee_yt | 1:3f2890d103fb | 3 | #include "Utils.h" |
yueee_yt | 1:3f2890d103fb | 4 | |
yueee_yt | 1:3f2890d103fb | 5 | u8 ms_buf[0x1A]; // USPS Streaming Buffer |
yueee_yt | 1:3f2890d103fb | 6 | int nUSPS; |
yueee_yt | 1:3f2890d103fb | 7 | int dUSPS[10]; |
yueee_yt | 1:3f2890d103fb | 8 | int eUSPS[10]; |
yueee_yt | 1:3f2890d103fb | 9 | void usps_cmd(int device,int cmd,int val,int len,int evt); |
yueee_yt | 1:3f2890d103fb | 10 | void usps_measurement_mode(int device); |
yueee_yt | 1:3f2890d103fb | 11 | void USPS_Refresh(); |
yueee_yt | 1:3f2890d103fb | 12 | |
yueee_yt | 1:3f2890d103fb | 13 | bool usps_debug=true; |
yueee_yt | 1:3f2890d103fb | 14 | |
yueee_yt | 1:3f2890d103fb | 15 | /* protocol */ |
yueee_yt | 1:3f2890d103fb | 16 | #define USPS_CMD_START 0x01 |
yueee_yt | 1:3f2890d103fb | 17 | #define USPS_CMD_VALUE 0x20 |
yueee_yt | 1:3f2890d103fb | 18 | #define USPS_CMD_GET_FIRMWARE 0xc0 |
yueee_yt | 1:3f2890d103fb | 19 | #define USPS_CMD_GET_SERIAL 0xc1 |
yueee_yt | 1:3f2890d103fb | 20 | #define USPS_CMD_GET_VOLTAGE 0xb0 |
yueee_yt | 1:3f2890d103fb | 21 | #define USPS_CMD_GET_TEMP 0xb4 |
yueee_yt | 1:3f2890d103fb | 22 | #define USPS_CMD_GET_FREQ 0xa1 |
yueee_yt | 1:3f2890d103fb | 23 | |
yueee_yt | 1:3f2890d103fb | 24 | #define USPS_MODE_WATTAGE 0x10 |
yueee_yt | 1:3f2890d103fb | 25 | #define USPS_MODE_CURRENT 0x30 |
yueee_yt | 1:3f2890d103fb | 26 | |
yueee_yt | 1:3f2890d103fb | 27 | #define EVENT_GET_FIRMWARE 0x11 |
yueee_yt | 1:3f2890d103fb | 28 | #define EVENT_GET_SERIAL 0x12 |
yueee_yt | 1:3f2890d103fb | 29 | #define EVENT_GET_TEMP 0x21 |
yueee_yt | 1:3f2890d103fb | 30 | #define EVENT_GET_VOLT 0x22 |
yueee_yt | 1:3f2890d103fb | 31 | #define EVENT_GET_FREQ 0x23 |
yueee_yt | 1:3f2890d103fb | 32 | #define EVENT_GET_POWER 0x24 |
yueee_yt | 1:3f2890d103fb | 33 | #define EVENT_START 0x13 |
yueee_yt | 1:3f2890d103fb | 34 | #define EVENT_VALUE 0x14 |
yueee_yt | 1:3f2890d103fb | 35 | |
yueee_yt | 1:3f2890d103fb | 36 | float temp; |
yueee_yt | 1:3f2890d103fb | 37 | float volt; |
yueee_yt | 1:3f2890d103fb | 38 | float freq; |
yueee_yt | 1:3f2890d103fb | 39 | float power1,power2,power3,power4; |
yueee_yt | 1:3f2890d103fb | 40 | unsigned char cmdFlag; |
yueee_yt | 1:3f2890d103fb | 41 | |
yueee_yt | 1:3f2890d103fb | 42 | void InitUSPS() |
yueee_yt | 1:3f2890d103fb | 43 | { |
yueee_yt | 1:3f2890d103fb | 44 | nUSPS=0; |
yueee_yt | 1:3f2890d103fb | 45 | } |
yueee_yt | 1:3f2890d103fb | 46 | |
yueee_yt | 1:3f2890d103fb | 47 | void UspsEventCallback(int device, int endpoint, int status, u8* data, int len, void* userData) |
yueee_yt | 1:3f2890d103fb | 48 | { |
yueee_yt | 1:3f2890d103fb | 49 | int i; |
yueee_yt | 1:3f2890d103fb | 50 | int Flag=0; |
yueee_yt | 1:3f2890d103fb | 51 | int ptr = 0; |
yueee_yt | 1:3f2890d103fb | 52 | if(status!=0) { |
yueee_yt | 1:3f2890d103fb | 53 | int i1=0; |
yueee_yt | 1:3f2890d103fb | 54 | if(usps_debug) printf("USPS Callback Status %d \n\r",status); |
yueee_yt | 1:3f2890d103fb | 55 | for(i=0; i<nUSPS; i++) { |
yueee_yt | 1:3f2890d103fb | 56 | if(dUSPS[i]==device) { |
yueee_yt | 1:3f2890d103fb | 57 | i1=i; |
yueee_yt | 1:3f2890d103fb | 58 | Flag=1; |
yueee_yt | 1:3f2890d103fb | 59 | } |
yueee_yt | 1:3f2890d103fb | 60 | } |
yueee_yt | 1:3f2890d103fb | 61 | if(Flag==1) { |
yueee_yt | 1:3f2890d103fb | 62 | for(i=i1+1; i<nUSPS; i++) { |
yueee_yt | 1:3f2890d103fb | 63 | dUSPS[i-1]=dUSPS[i]; |
yueee_yt | 1:3f2890d103fb | 64 | eUSPS[i-1]=eUSPS[i]; |
yueee_yt | 1:3f2890d103fb | 65 | } |
yueee_yt | 1:3f2890d103fb | 66 | nUSPS--; |
yueee_yt | 1:3f2890d103fb | 67 | } |
yueee_yt | 1:3f2890d103fb | 68 | return; |
yueee_yt | 1:3f2890d103fb | 69 | } |
yueee_yt | 1:3f2890d103fb | 70 | switch((int)userData) { |
yueee_yt | 1:3f2890d103fb | 71 | case EVENT_GET_FIRMWARE: |
yueee_yt | 1:3f2890d103fb | 72 | if(usps_debug) printf("USPS Device#%X Firmware VOL%X REL%X\r\n",device,data[0],data[1]); |
yueee_yt | 1:3f2890d103fb | 73 | break; |
yueee_yt | 1:3f2890d103fb | 74 | case EVENT_GET_SERIAL: |
yueee_yt | 1:3f2890d103fb | 75 | i=data[0]<<16|data[1]<<8|data[2]; |
yueee_yt | 1:3f2890d103fb | 76 | if(usps_debug) printf("USPS Device#%x SerialNo %X \r\n",device,i); |
yueee_yt | 1:3f2890d103fb | 77 | break; |
yueee_yt | 1:3f2890d103fb | 78 | case EVENT_GET_TEMP: |
yueee_yt | 1:3f2890d103fb | 79 | i=data[1]<<8|data[0]; |
yueee_yt | 1:3f2890d103fb | 80 | temp=i/100.0; |
yueee_yt | 1:3f2890d103fb | 81 | if(usps_debug) printf("USPS Device#%x Temp %5.2f \r\n",device,temp); |
yueee_yt | 1:3f2890d103fb | 82 | break; |
yueee_yt | 1:3f2890d103fb | 83 | case EVENT_GET_VOLT: |
yueee_yt | 1:3f2890d103fb | 84 | volt=data[0]; |
yueee_yt | 1:3f2890d103fb | 85 | if(usps_debug) printf("USPS Device#%x Volt %6.2f \r\n",device,volt); |
yueee_yt | 1:3f2890d103fb | 86 | break; |
yueee_yt | 1:3f2890d103fb | 87 | case EVENT_GET_FREQ: |
yueee_yt | 1:3f2890d103fb | 88 | i=data[1]<<8|data[0]; |
yueee_yt | 1:3f2890d103fb | 89 | freq=2000000.0/i; |
yueee_yt | 1:3f2890d103fb | 90 | if(usps_debug) printf("USPS Device#%x Freq %5.2f \r\n",device,freq); |
yueee_yt | 1:3f2890d103fb | 91 | break; |
yueee_yt | 1:3f2890d103fb | 92 | case EVENT_GET_POWER: |
yueee_yt | 1:3f2890d103fb | 93 | power4=(unsigned short)(data[0xf]<<8|data[0xe]); |
yueee_yt | 1:3f2890d103fb | 94 | power3=(unsigned short)(data[0xd]<<8|data[0xc]); |
yueee_yt | 1:3f2890d103fb | 95 | power2=(unsigned short)(data[0xb]<<8|data[0xa]); |
yueee_yt | 1:3f2890d103fb | 96 | power1=(unsigned short)(data[0x9]<<8|data[0x8]); |
yueee_yt | 1:3f2890d103fb | 97 | if(usps_debug) printf("USPS Device#%x:Power1 %5.0f[W]:Power2 %5.0f[W]:Power3 %5.0f[W]:Power4 %5.0f[W]\r\n",device,power1,power2,power3,power4); |
yueee_yt | 1:3f2890d103fb | 98 | break; |
yueee_yt | 1:3f2890d103fb | 99 | default: |
yueee_yt | 1:3f2890d103fb | 100 | if(usps_debug) printf("usps response \r\n"); |
yueee_yt | 1:3f2890d103fb | 101 | if(usps_debug) printf("USPS %02X %02X %02X \r\n",device,status,len); |
yueee_yt | 1:3f2890d103fb | 102 | if(usps_debug) printfBytes("",data,len); |
yueee_yt | 1:3f2890d103fb | 103 | } |
yueee_yt | 1:3f2890d103fb | 104 | } |
yueee_yt | 1:3f2890d103fb | 105 | |
yueee_yt | 1:3f2890d103fb | 106 | // Add Usps Interface |
yueee_yt | 1:3f2890d103fb | 107 | void USPS_Refresh() |
yueee_yt | 1:3f2890d103fb | 108 | { |
yueee_yt | 1:3f2890d103fb | 109 | int i; |
yueee_yt | 1:3f2890d103fb | 110 | u8* dst = ms_buf; |
yueee_yt | 1:3f2890d103fb | 111 | for (i=0; i<nUSPS; i++) { |
yueee_yt | 1:3f2890d103fb | 112 | usps_cmd(dUSPS[i],USPS_CMD_GET_TEMP ,0,2,EVENT_GET_TEMP); |
yueee_yt | 1:3f2890d103fb | 113 | usps_cmd(dUSPS[i],USPS_CMD_GET_VOLTAGE, 0, 1,EVENT_GET_VOLT); |
yueee_yt | 1:3f2890d103fb | 114 | usps_cmd(dUSPS[i],USPS_CMD_GET_FREQ, 0, 8,EVENT_GET_FREQ); |
yueee_yt | 1:3f2890d103fb | 115 | USBInterruptTransfer(dUSPS[i], eUSPS[i], dst,0x10, UspsEventCallback, (void*)EVENT_GET_POWER); |
yueee_yt | 1:3f2890d103fb | 116 | } |
yueee_yt | 1:3f2890d103fb | 117 | } |
yueee_yt | 1:3f2890d103fb | 118 | |
yueee_yt | 1:3f2890d103fb | 119 | void AddUspsInterface(int device, InterfaceDescriptor* id, EndpointDescriptor* ed,int len) |
yueee_yt | 1:3f2890d103fb | 120 | { |
yueee_yt | 1:3f2890d103fb | 121 | if ((ed->bmAttributes & 3) != ENDPOINT_INTERRUPT || !(ed->bEndpointAddress & 0x80)) |
yueee_yt | 1:3f2890d103fb | 122 | return; |
yueee_yt | 1:3f2890d103fb | 123 | usps_cmd(device,USPS_CMD_GET_FIRMWARE ,0,2,EVENT_GET_FIRMWARE); |
yueee_yt | 1:3f2890d103fb | 124 | usps_cmd(device,USPS_CMD_GET_SERIAL ,0,3,EVENT_GET_SERIAL); |
yueee_yt | 1:3f2890d103fb | 125 | usps_measurement_mode(device); |
yueee_yt | 1:3f2890d103fb | 126 | dUSPS[nUSPS]=device; |
yueee_yt | 1:3f2890d103fb | 127 | eUSPS[nUSPS]=ed->bEndpointAddress; |
yueee_yt | 1:3f2890d103fb | 128 | nUSPS++; |
yueee_yt | 1:3f2890d103fb | 129 | } |
yueee_yt | 1:3f2890d103fb | 130 | |
yueee_yt | 1:3f2890d103fb | 131 | void usps_measurement_mode(int device) |
yueee_yt | 1:3f2890d103fb | 132 | { |
yueee_yt | 1:3f2890d103fb | 133 | int i; |
yueee_yt | 1:3f2890d103fb | 134 | u8* dst = ms_buf; |
yueee_yt | 1:3f2890d103fb | 135 | i= USBControlTransfer(device, 0x40, USPS_CMD_START ,0, 0, dst, 0,UspsEventCallback,(void*)EVENT_START); //UT_Vendor_Write |
yueee_yt | 1:3f2890d103fb | 136 | i= USBControlTransfer(device, 0x40, USPS_CMD_VALUE ,USPS_MODE_WATTAGE , 0, dst, 0,UspsEventCallback,(void*)EVENT_VALUE); //UT_Vendor_Write |
yueee_yt | 1:3f2890d103fb | 137 | } |
yueee_yt | 1:3f2890d103fb | 138 | |
yueee_yt | 1:3f2890d103fb | 139 | void usps_cmd(int device,int cmd,int val,int len,int evt) |
yueee_yt | 1:3f2890d103fb | 140 | { |
yueee_yt | 1:3f2890d103fb | 141 | int i; |
yueee_yt | 1:3f2890d103fb | 142 | u8* dst = ms_buf; |
yueee_yt | 1:3f2890d103fb | 143 | i= USBControlTransfer(device, 0xc0, cmd,val, 0, dst, len,UspsEventCallback,(void*)evt); |
yueee_yt | 1:3f2890d103fb | 144 | if(i!=-100) printf("status : %d \r\n",i); |
yueee_yt | 1:3f2890d103fb | 145 | } |
yueee_yt | 1:3f2890d103fb | 146 | // Detected USPS Device |
yueee_yt | 1:3f2890d103fb | 147 | int OnUspsInsert(int device) |
yueee_yt | 1:3f2890d103fb | 148 | { |
yueee_yt | 1:3f2890d103fb | 149 | u8 buffer[255]; |
yueee_yt | 1:3f2890d103fb | 150 | int err = GetDescriptor(device,DESCRIPTOR_TYPE_CONFIGURATION,0,buffer,255); |
yueee_yt | 1:3f2890d103fb | 151 | if (err < 0) |
yueee_yt | 1:3f2890d103fb | 152 | return err; |
yueee_yt | 1:3f2890d103fb | 153 | int len = buffer[2] | (buffer[3] << 8); |
yueee_yt | 1:3f2890d103fb | 154 | u8* d = buffer; |
yueee_yt | 1:3f2890d103fb | 155 | u8* end = d + len; |
yueee_yt | 1:3f2890d103fb | 156 | |
yueee_yt | 1:3f2890d103fb | 157 | if(usps_debug) printf("OnUspsInsert %02X %02X\r\n",device,len); // |
yueee_yt | 1:3f2890d103fb | 158 | //printfBytes(" -->",d,len); |
yueee_yt | 1:3f2890d103fb | 159 | while (d < end) { |
yueee_yt | 1:3f2890d103fb | 160 | if (d[1] == DESCRIPTOR_TYPE_INTERFACE) { |
yueee_yt | 1:3f2890d103fb | 161 | InterfaceDescriptor* id = (InterfaceDescriptor*)d; |
yueee_yt | 1:3f2890d103fb | 162 | d += d[0]; |
yueee_yt | 1:3f2890d103fb | 163 | while (d < end) { |
yueee_yt | 1:3f2890d103fb | 164 | if (d[1] == DESCRIPTOR_TYPE_ENDPOINT) { |
yueee_yt | 1:3f2890d103fb | 165 | if(usps_debug) printfBytes("Usps Endpoint",d,d[0]); |
yueee_yt | 1:3f2890d103fb | 166 | AddUspsInterface(device,id,(EndpointDescriptor*)d,d[4]); |
yueee_yt | 1:3f2890d103fb | 167 | } |
yueee_yt | 1:3f2890d103fb | 168 | d += d[0]; |
yueee_yt | 1:3f2890d103fb | 169 | } |
yueee_yt | 1:3f2890d103fb | 170 | } |
yueee_yt | 1:3f2890d103fb | 171 | d += d[0]; |
yueee_yt | 1:3f2890d103fb | 172 | } |
yueee_yt | 1:3f2890d103fb | 173 | return 0; |
yueee_yt | 1:3f2890d103fb | 174 | } |