/********************************************************************
* データ引取りモードの設定
********************************************************************
*/
void cmd_set_mode(void)
{
poll_mode = PacketFromPC.size;
poll_addr = (uchar near *) PacketFromPC.adrs;
if( poll_mode == POLL_ANALOG) {
mInitPOT();
ADCON0bits.GO = 1; // Start AD conversion
}
make_report();
}
/********************************************************************
* データ引取りモードの設定
********************************************************************
*/
void cmd_set_mode(void)
{
poll_mode = BSWAP16( PacketFromPC.size );
poll_addr = (uchar *) BSWAP32( PacketFromPC.adrs );
if( poll_mode == POLL_ANALOG) {
// mInitPOT();
// ADCON0bits.GO = 1; // Start AD conversion
}
make_report();
}
/********************************************************************
* モニタコマンド受信と実行.
********************************************************************
*/
void ProcessIO(void)
{
// 返答パケットが空であること、かつ、
// 処理対象の受信データがある.
{ //if((ToPcRdy == 0)) {
//受信データがあれば、受信データを受け取る.
PacketToPC.raw[0]=Cmd0; // CMD ECHOBACK
#if APPLICATION_MODE
#if PICAVR_WRITER
//コマンドに対応する処理を呼び出す.
if(Cmd0 >= HIDASP_PAGE_TX) {cmd_avrspx();} // AVRライターコマンド.
else
#endif
if(Cmd0 >= PICSPX_SETADRS24){cmd_picspx();} // PICライターコマンド.
else
#endif
switch(Cmd0) {
case HIDASP_PEEK: {cmd_peek();break;} // メモリー読み出し.
case HIDASP_POKE: {cmd_poke();break;} // メモリー書き込み.
case HIDASP_JMP: {cmd_exec(
BSWAP32(PacketFromPC.adrs),BSWAP16(PacketFromPC.size)
);
break;} // 実行.
case HIDASP_PAGE_ERASE:{cmd_page_erase();break;} //Flash消去.
case HIDASP_PAGE_WRITE:{cmd_page_write();break;} //Flash書込.
case HIDASP_FLASH_LOCK:{cmd_flash_lock();break;} //FlashLock.
case HIDASP_SET_MODE: {cmd_set_mode();break;}
case HIDASP_SAMPLING: {cmd_sampling();break;}
case HIDASP_TEST: {cmd_echo();break;} // 接続テスト.
#if APPLICATION_MODE
case HIDASP_GET_STRING:{cmd_get_string();break;}
case HIDASP_USER_CMD: {cmd_user_cmd();break;}
#endif
default: break;
}
}
// 必要なら、返答パケットをインタラプト転送(EP1)でホストPCに返却する.
if( ToPcRdy ) {
USBputpacket(PacketToPC.raw,PACKET_SIZE);
ToPcRdy = 0;
if(poll_mode!=0) {
if(mHIDRxIsBusy()) { //コマンドが来ない限り送り続ける.
make_report();
}
}
}
}
static int snapshot(lua_State* L) {
lua_State *dL = luaL_newstate();
int len;
const void * p;
lua_newtable(dL);
#if LUA_VERSION_NUM == 503
lua_rawgeti(L, LUA_REGISTRYINDEX, LUA_RIDX_GLOBALS);
#else
lua_pushvalue(L, LUA_GLOBALSINDEX);
#endif
mark_root_table(L, dL, RT_GLOBAL);
lua_pop(L, 1);
lua_pushvalue(L, LUA_REGISTRYINDEX);
p = lua_topointer(L, -1);
len = mark_root_table(L, dL, RT_REGISTRY);
lua_pop(L, 1);
make_report(L, dL);
lua_newtable(L);
lua_pushstring(L, "[REGISTRY Level 1]");
lua_setfield(L, -2, "name");
lua_pushnumber(L, RT_REGISTRY);
lua_setfield(L, -2, "type");
lua_pushnumber(L, len);
lua_setfield(L, -2, "size");
lua_pushfstring(L, "%p", p);
lua_setfield(L, -2, "pointer");
lua_pushstring(L, "");
lua_setfield(L, -2, "used_in");
lua_rawseti(L, -2, lua_objlen(L, -2) + 1);
lua_close(dL);
return 1;
}
/********************************************************************
* モニタコマンド受信と実行.
********************************************************************
*/
void ProcessIO(void)
{
// 返答パケットが空であること、かつ、
// 処理対象の受信データがある.
if((ToPcRdy == 0) && (USBHandleBusy(USBGenericOutHandle)==0) ) {
//受信データがあれば、受信データを受け取る.
memcpy64((char*)&PacketFromPC,(char*)OUTPacket);
//次の読み込みを発行する.
USBGenericOutHandle = USBGenRead(USBGEN_EP_NUM,(BYTE*)&OUTPacket
,USBGEN_EP_SIZE);
PacketToPC.raw[0]=Cmd0; // CMD ECHOBACK
//コマンドに対応する処理を呼び出す.
if(Cmd0==HIDASP_PEEK) {cmd_peek();} // メモリー読み出し.
else if(Cmd0==HIDASP_POKE) {cmd_poke();} // メモリー書き込み.
else if(Cmd0==HIDASP_JMP) {cmd_exec();} // 実行.
else if(Cmd0==HIDASP_TEST) {cmd_echo();} // 接続テスト.
else if(Cmd0==HIDASP_GET_STRING){cmd_get_string();}
else if(Cmd0==HIDASP_USER_CMD) {cmd_user_cmd();}
else if(Cmd0==HIDASP_SET_MODE) {cmd_set_mode();}
}
// 必要なら、返答パケットをバルク転送(EP1)でホストPCに返却する.
if( ToPcRdy ) {
if(!USBHandleBusy(USBGenericInHandle)) {
memcpy64(INPacket,(char*)&PacketToPC);
USBGenericInHandle=USBGenWrite(USBGEN_EP_NUM,(BYTE*)INPacket,USBGEN_EP_SIZE);
ToPcRdy = 0;
if(poll_mode!=0) {
if( USBHandleBusy(USBGenericOutHandle) ) {//コマンドが来ない限り送り続ける.
make_report();
}
}
}
}
}
/********************************************************************
* モニタコマンド受信と実行.
********************************************************************
*/
void ProcessIO(void)
{
// 返答パケットが空であること、かつ、
// 処理対象の受信データがある.
if((ToPcRdy == 0) && (!mHIDRxIsBusy())) {
//受信データがあれば、受信データを受け取る.
HIDRxReport64((char *)&PacketFromPC);
PacketToPC.raw[0]=Cmd0; // CMD ECHOBACK
//コマンドに対応する処理を呼び出す.
if(Cmd0 >= HIDASP_PAGE_TX) {cmd_avrspx();} // AVRライターコマンド.
else if(Cmd0 >= PICSPX_SETADRS24){cmd_picspx();} // PICライターコマンド.
else if(Cmd0==HIDASP_PEEK) {cmd_peek();} // メモリー読み出し.
else if(Cmd0==HIDASP_POKE) {cmd_poke();} // メモリー書き込み.
else if(Cmd0==HIDASP_JMP) {cmd_exec();} // 実行.
else if(Cmd0==HIDASP_SET_MODE) {cmd_set_mode();}
else if(Cmd0==HIDASP_GET_STRING){cmd_get_string();}
else if(Cmd0==HIDASP_USER_CMD) {cmd_user_cmd();}
else if(Cmd0==HIDASP_TEST) {cmd_echo();} // 接続テスト.
}
// 必要なら、返答パケットをインタラプト転送(EP1)でホストPCに返却する.
if( ToPcRdy ) {
if(!mHIDTxIsBusy()) {
HIDTxReport64((char *)&PacketToPC);
ToPcRdy = 0;
if(poll_mode!=0) {
if(mHIDRxIsBusy()) { //コマンドが来ない限り送り続ける.
make_report();
}
}
}
}
}
inline void detailed_report( test_unit_id id = INV_TEST_UNIT_ID )
{ make_report( DETAILED_REPORT, id ); }
int main(int argc, char **argv)
{
int option_index;
int c;
char filename[4096];
char workload[4096] = {0,};
int iterations = 1, auto_tune = 0;
set_new_handler(out_of_memory);
setlocale (LC_ALL, "");
bindtextdomain (PACKAGE, LOCALEDIR);
textdomain (PACKAGE);
while (1) { /* parse commandline options */
c = getopt_long (argc, argv, "ch:C:i:t:uVw:q", long_options, &option_index);
/* Detect the end of the options. */
if (c == -1)
break;
switch (c) {
case 'V':
print_version();
exit(0);
break;
case 'e': /* Extech power analyzer support */
checkroot();
extech_power_meter(optarg ? optarg : "/dev/ttyUSB0");
break;
case 'u':
print_usage();
exit(0);
break;
case 'a':
auto_tune = 1;
leave_powertop = 1;
break;
case 'c':
powertop_init();
calibrate();
break;
case 'h': /* html report */
reporttype = REPORT_HTML;
sprintf(filename, "%s", optarg ? optarg : "powertop.html" );
break;
case 't':
time_out = (optarg ? atoi(optarg) : 20);
break;
case 'i':
iterations = (optarg ? atoi(optarg) : 1);
break;
case 'w': /* measure workload */
sprintf(workload, "%s", optarg ? optarg :'\0' );
break;
case 'q':
if(freopen("/dev/null", "a", stderr))
fprintf(stderr, _("Quite mode failed!\n"));
break;
case 'C': /* csv report*/
reporttype = REPORT_CSV;
sprintf(filename, "%s", optarg ? optarg : "powertop.csv");
break;
case '?': /* Unknown option */
/* getopt_long already printed an error message. */
exit(0);
break;
}
}
powertop_init();
if (reporttype != REPORT_OFF)
make_report(time_out, workload, iterations, filename);
if (debug_learning)
printf("Learning debugging enabled\n");
learn_parameters(250, 0);
save_parameters("saved_parameters.powertop");
if (debug_learning) {
learn_parameters(1000, 1);
dump_parameter_bundle();
end_pci_access();
exit(0);
}
init_display();
initialize_tuning();
/* first one is short to not let the user wait too long */
one_measurement(1, NULL);
if (!auto_tune) {
tuning_update_display();
show_tab(0);
} else {
auto_toggle_tuning();
}
while (!leave_powertop) {
show_cur_tab();
one_measurement(time_out, NULL);
learn_parameters(15, 0);
}
endwin();
printf("%s\n", _("Leaving PowerTOP"));
end_process_data();
clear_process_data();
end_cpu_data();
clear_cpu_data();
save_all_results("saved_results.powertop");
save_parameters("saved_parameters.powertop");
learn_parameters(500, 0);
save_parameters("saved_parameters.powertop");
end_pci_access();
clear_tuning();
reset_display();
clean_shutdown();
return 0;
}
/**@brief Function for handling the Application's BLE Stack events.
*
* @param[in] p_ble_evt Bluetooth stack event.
*/
static void on_ble_evt(ble_evt_t * p_ble_evt)
{
uint32_t err_code;
const ble_gap_evt_t * p_gap_evt = &p_ble_evt->evt.gap_evt;
switch (p_ble_evt->header.evt_id)
{
case BLE_GAP_EVT_ADV_REPORT:
{
const ble_gap_evt_adv_report_t *p_adv_report = &p_gap_evt->params.adv_report;
//TODO: implement whitelist
bool friend = true;
// Whitelist substitute
for (int i = 0; i < BLE_GAP_ADDR_LEN - 1; i++)
// Last number of address doesnt count. Others should be same as ours.
{
if (p_adv_report->peer_addr.addr[BLE_GAP_ADDR_LEN - 1 - i] != l_device_address[i])
{
friend = false;
break;
}
}
if (friend)
{
make_report(NRF_RTC1->COUNTER, timer_epoch, p_adv_report->rssi, p_adv_report->peer_addr.addr[0]);
}
break;
}
case BLE_GAP_EVT_CONNECTED:
err_code = NRF_SUCCESS;
sd_ble_gap_scan_stop();
__LOG("conn. scan stopped");
APP_ERROR_CHECK(err_code);
m_conn_handle = p_ble_evt->evt.gap_evt.conn_handle;
break;
case BLE_GAP_EVT_DISCONNECTED:
m_conn_handle = BLE_CONN_HANDLE_INVALID;
__LOG("disco. scan start");
scan_start();
//initialize advertising again in case power level changed.
//advertised power is not by default tx power
advertising_init();
advertising_start();
break;
case BLE_GAP_EVT_TIMEOUT:
//advertising starts itself.
scan_start();
__LOG("timeout. scan start");
break;
case BLE_GATTS_EVT_TIMEOUT:
if (p_ble_evt->evt.gatts_evt.params.timeout.src == BLE_GATT_TIMEOUT_SRC_PROTOCOL)
{
err_code = sd_ble_gap_disconnect(m_conn_handle,
BLE_HCI_REMOTE_USER_TERMINATED_CONNECTION);
APP_ERROR_CHECK(err_code);
}
//TODO: manage timeout.
__LOG("GATTS timeout.");
break;
case BLE_EVT_TX_COMPLETE:
if (m_file_in_transit) ble_nus_data_transfer();
break;
default:
// No implementation needed.
break;
}
}
inline void short_report( test_unit_id id = INV_TEST_UNIT_ID ) { make_report( SHORT_REPORT, id ); }
inline void confirmation_report( test_unit_id id = INV_TEST_UNIT_ID ) { make_report( CONFIRMATION_REPORT, id ); }
