スマートコンセント PS-5204PSをmbedで
Dependencies: FatFileSystemCpp mbed TextLCD
Fork of BlueUSB by
Fusjitsu スマートコンセント FX-5204PSを利用できます。
BlueUSBを利用していますが、Bluetoothは兼用できません。
複数台利用するには、USBハブを使用してください。ただし相性があります。
・良ければ10台まで利用できるかも。
・稼働中に追加はできますが、外すことはできません。
LED1-3, スマートコンセント接続状態(3台まで表示)
LED4、点滅で正常動作
usps.cpp
- Committer:
- yueee_yt
- Date:
- 2012-09-27
- Revision:
- 2:32a2d06f4fe2
- Parent:
- 1:3f2890d103fb
File content as of revision 2:32a2d06f4fe2:
#include "mbed.h" #include "USBHost.h" #include "Utils.h" u8 ms_buf[0x1A]; // USPS Streaming Buffer int nUSPS; int dUSPS[10]; int eUSPS[10]; int SerialNo[10]; float TempData[10]; float VoltData[10]; float FreqData[10]; float WattData1[10],WattData2[10],WattData3[10],WattData4[10]; void usps_cmd(int device,int cmd,int val,int len,int evt); void usps_measurement_mode(int device); void USPS_Refresh(); bool usps_debug=true; /* protocol */ #define USPS_CMD_START 0x01 #define USPS_CMD_VALUE 0x20 #define USPS_CMD_GET_FIRMWARE 0xc0 #define USPS_CMD_GET_SERIAL 0xc1 #define USPS_CMD_GET_VOLTAGE 0xb0 #define USPS_CMD_GET_TEMP 0xb4 #define USPS_CMD_GET_FREQ 0xa1 #define USPS_MODE_WATTAGE 0x10 #define USPS_MODE_CURRENT 0x30 #define EVENT_GET_FIRMWARE 0x11 #define EVENT_GET_SERIAL 0x12 #define EVENT_GET_TEMP 0x21 #define EVENT_GET_VOLT 0x22 #define EVENT_GET_FREQ 0x23 #define EVENT_GET_POWER 0x24 #define EVENT_START 0x13 #define EVENT_VALUE 0x14 float temp; float volt; float freq; float power1,power2,power3,power4; unsigned char cmdFlag; bool initFlag; void InitUSPS() { int i; nUSPS=0; for(i=0; i<10; i++)SerialNo[i]=0; initFlag=false; } void UspsEventCallback(int device, int endpoint, int status, u8* data, int len, void* userData) { int i,i1,i2,sn; int Flag=0; if(status!=0) { i1=0; if(usps_debug) printf("USPS Callback Status %d \n\r",status); for(i=0; i<nUSPS; i++) { if(dUSPS[i]==device) { i1=i; Flag=1; } } if(Flag==1) { for(i=i1+1; i<nUSPS; i++) { dUSPS[i-1]=dUSPS[i]; eUSPS[i-1]=eUSPS[i]; SerialNo[i-1]=SerialNo[i]; TempData[i-1]=TempData[i]; VoltData[i-1]=VoltData[i]; FreqData[i-1]=FreqData[i]; WattData1[i-1]=WattData1[i]; WattData2[i-1]=WattData2[i]; WattData3[i-1]=WattData3[i]; WattData4[i-1]=WattData4[i]; } nUSPS--; } return; } i2=(int)userData; switch(i2) { case EVENT_GET_FIRMWARE: if(usps_debug) printf("USPS Device#%X Firmware VOL%X REL%X\r\n",device,data[0],data[1]); break; case EVENT_GET_SERIAL: i1=0; sn=data[0]<<16|data[1]<<8|data[2]; if(usps_debug) printf("USPS Device#%x SerialNo %X \r\n",device,sn); for(i=0; i<nUSPS; i++) { if(SerialNo[i]==sn) { i1=i; Flag=1; } } if(Flag==1) { for(i=i1+1; i<nUSPS; i++) { dUSPS[i-1]=dUSPS[i]; eUSPS[i-1]=eUSPS[i]; SerialNo[i-1]=SerialNo[i]; TempData[i-1]=TempData[i]; VoltData[i-1]=VoltData[i]; FreqData[i-1]=FreqData[i]; WattData1[i-1]=WattData1[i]; WattData2[i-1]=WattData2[i]; WattData3[i-1]=WattData3[i]; WattData4[i-1]=WattData4[i]; } nUSPS--; } for(i=0; i<nUSPS; i++) { if(dUSPS[i]==device)SerialNo[i]=sn; } for(i=0; i<nUSPS; i++) { if(usps_debug) printf( "Serial(%d) : %X \n\r",i,SerialNo[i]); } break; case EVENT_GET_TEMP: i=data[1]<<8|data[0]; temp=i/100.0; if(usps_debug) printf("USPS Device#%x Temp %5.2f \r\n",device,temp); for(i=0; i<nUSPS; i++) { if(dUSPS[i]==device)TempData[i]=temp; } break; case EVENT_GET_VOLT: volt=data[0]; if(usps_debug) printf("USPS Device#%x Volt %6.2f \r\n",device,volt); for(i=0; i<nUSPS; i++) { if(dUSPS[i]==device)VoltData[i]=volt; } break; case EVENT_GET_FREQ: i=data[1]<<8|data[0]; freq=2000000.0/i; if(usps_debug) printf("USPS Device#%x Freq %5.2f \r\n",device,freq); for(i=0; i<nUSPS; i++) { if(dUSPS[i]==device)FreqData[i]=freq; } break; case EVENT_GET_POWER: power4=(unsigned short)(data[0xf]<<8|data[0xe]); power3=(unsigned short)(data[0xd]<<8|data[0xc]); power2=(unsigned short)(data[0xb]<<8|data[0xa]); power1=(unsigned short)(data[0x9]<<8|data[0x8]); 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); for(i=0; i<nUSPS; i++) { if(dUSPS[i]==device) { WattData1[i]=power1; WattData2[i]=power2; WattData3[i]=power3; WattData4[i]=power4; } } break; default: if(usps_debug) printf("usps response \r\n"); if(usps_debug) printf("USPS %02X %02X %02X \r\n",device,status,len); if(usps_debug) printfBytes("",data,len); break; } } // Add Usps Interface void USPS_Refresh() { static int i=0; static int k=0; u8* dst = ms_buf; //for (i=0; i<nUSPS; i++) { if(nUSPS==0)return; if(initFlag==true) { for(i=0; i<nUSPS; i++) { if(SerialNo[i]==0) { usps_cmd(dUSPS[i],USPS_CMD_GET_SERIAL ,0,3,EVENT_GET_SERIAL); usps_measurement_mode(dUSPS[i]); } } k=0; for(i=0; i<nUSPS; i++)if(SerialNo[i]==0)k=1; if(k==0)initFlag=false; } else { if(i==nUSPS)i=0; switch(k) { case 0: usps_cmd(dUSPS[i],USPS_CMD_GET_TEMP ,0,2,EVENT_GET_TEMP); k++; break; case 1: usps_cmd(dUSPS[i],USPS_CMD_GET_VOLTAGE, 0, 1,EVENT_GET_VOLT); k++; break; case 2: usps_cmd(dUSPS[i],USPS_CMD_GET_FREQ, 0, 8,EVENT_GET_FREQ); k++; break; case 3: USBInterruptTransfer(dUSPS[i], eUSPS[i], dst,0x10, UspsEventCallback, (void*)EVENT_GET_POWER); k=0; i++; break; } } //} } void AddUspsInterface(int device, InterfaceDescriptor* id, EndpointDescriptor* ed,int len) { if ((ed->bmAttributes & 3) != ENDPOINT_INTERRUPT || !(ed->bEndpointAddress & 0x80)) return; dUSPS[nUSPS]=device; eUSPS[nUSPS]=ed->bEndpointAddress; SerialNo[nUSPS]=0; nUSPS++; if(usps_debug) printf("No of USPS :%d\n\r",nUSPS); initFlag=true; // usps_cmd(device,USPS_CMD_GET_FIRMWARE ,0,2,EVENT_GET_FIRMWARE); // usps_cmd(device,USPS_CMD_GET_SERIAL ,0,3,EVENT_GET_SERIAL); // usps_measurement_mode(device); } void usps_measurement_mode(int device) { u8* dst = ms_buf; USBControlTransfer(device, 0x40, USPS_CMD_START ,0, 0, dst, 0,UspsEventCallback,(void*)EVENT_START); //UT_Vendor_Write USBControlTransfer(device, 0x40, USPS_CMD_VALUE ,USPS_MODE_WATTAGE , 0, dst, 0,UspsEventCallback,(void*)EVENT_VALUE); //UT_Vendor_Write } void usps_cmd(int device,int cmd,int val,int len,int evt) { int i; u8* dst = ms_buf; // printf("req\n\r"); i= USBControlTransfer(device, 0xc0, cmd,val, 0, dst, len,UspsEventCallback,(void*)evt); if(i!=-100) printf("status : %d \r\n",i); } // Detected USPS Device int OnUspsInsert(int device) { u8 buffer[255]; int err = GetDescriptor(device,DESCRIPTOR_TYPE_CONFIGURATION,0,buffer,255); if (err < 0) return err; int len = buffer[2] | (buffer[3] << 8); u8* d = buffer; u8* end = d + len; if(usps_debug) printf("OnUspsInsert %02X %02X\r\n",device,len); // //printfBytes(" -->",d,len); while (d < end) { if (d[1] == DESCRIPTOR_TYPE_INTERFACE) { InterfaceDescriptor* id = (InterfaceDescriptor*)d; d += d[0]; while (d < end) { if (d[1] == DESCRIPTOR_TYPE_ENDPOINT) { if(usps_debug) printfBytes("Usps Endpoint",d,d[0]); AddUspsInterface(device,id,(EndpointDescriptor*)d,d[4]); } d += d[0]; } } d += d[0]; } return 0; }