void CSUmbrella::initialise(size_t nID) { ID = nID; BOOST_FOREACH(const size_t& id, *range1) Sim->dynamics.getLiouvillean().updateParticle(Sim->particleList[id]); BOOST_FOREACH(const size_t& id, *range2) Sim->dynamics.getLiouvillean().updateParticle(Sim->particleList[id]); CPDData partdata(*Sim, *range1, *range2); ulevelcenter = int( - a * b * b / delU); double r = partdata.rij.nrm(); if (!ulevelset) { ulevel = int(a * (r - b) * (r - b) / delU); if (r < b) ulevel *= -1; ulevelset = true; } recalculateTime(); Sim->registerParticleUpdateFunc (magnet::function::MakeDelegate(this, &CSUmbrella::particlesUpdated)); }
void CSUmbrella::recalculateTime() { BOOST_FOREACH(const size_t& id, *range1) Sim->dynamics.getLiouvillean().updateParticle(Sim->particleList[id]); BOOST_FOREACH(const size_t& id, *range2) Sim->dynamics.getLiouvillean().updateParticle(Sim->particleList[id]); CPDData partdata(*Sim, *range1, *range2); double R_max, R_min; dt = HUGE_VAL; type = NONE; if (ulevel == ulevelcenter) { R_max = b - sqrt((ulevel * delU) / a); if (b==0)//Allow a double width well if b==0 R_max = b + sqrt((ulevel + 1 * delU) / a); //Just look for escaping as we're in the well step spanning r = 0 if (Sim->dynamics.getLiouvillean().SphereSphereOutRoot (partdata, R_max * R_max, true, true)) { dt = partdata.dt; type = WELL_OUT; } return; } if (ulevel == 0) { //We're on the minimum //We don't worry about the minimum crossing r=0, as this is //caught by the above if statement R_max = b + sqrt((1 * delU) / a); R_min = b - sqrt((1 * delU) / a); } else if (ulevel < 0) { R_max = b - sqrt((-ulevel) * delU / a); R_min = b - sqrt(((-ulevel) + 1) * delU / a); } else { R_min = b + sqrt((ulevel * delU) / a); R_max = b + sqrt(((ulevel + 1) * delU) / a); } if (Sim->dynamics.getLiouvillean().SphereSphereInRoot(partdata, R_min * R_min, true, true)) { dt = partdata.dt; type = WELL_IN; } else if (Sim->dynamics.getLiouvillean().SphereSphereOutRoot(partdata, R_max * R_max, true, true)) { dt = partdata.dt; type = WELL_OUT; } }
int ACE_TMAIN (int argc, ACE_TCHAR *argv[]) { try { ACE_DEBUG ((LM_DEBUG, "(%P|%t) monitor main\n")); DDS::DomainParticipantFactory_var dpf; DDS::DomainParticipant_var participant; dpf = TheParticipantFactoryWithArgs(argc, argv); if (parse_args (argc, argv) == -1) { return -1; } if (CUR_PART_USER_DATA == UPDATED_PART_USER_DATA) { // wait for Monitor 1 done FILE* fp = ACE_OS::fopen (synch_fname, ACE_TEXT("r")); int i = 0; while (fp == 0 && i < 15) { ACE_DEBUG ((LM_DEBUG, ACE_TEXT("(%P|%t) waiting monitor1 done ...\n"))); ACE_OS::sleep (1); ++ i; fp = ACE_OS::fopen (synch_fname, ACE_TEXT("r")); } if (fp != 0) ACE_OS::fclose (fp); } participant = dpf->create_participant(411, PARTICIPANT_QOS_DEFAULT, DDS::DomainParticipantListener::_nil(), ::OpenDDS::DCPS::DEFAULT_STATUS_MASK); if (CORBA::is_nil (participant.in ())) { ACE_ERROR((LM_ERROR, "(%P|%t) monitor: create_participant failed.\n")); return 1 ; } OpenDDS::DCPS::DomainParticipantImpl* part_svt = dynamic_cast<OpenDDS::DCPS::DomainParticipantImpl*>(participant.in ()); // give time for BIT datareader/datawriter fully association. ACE_OS::sleep (2); if (delay_before_read_sec > 0) { ACE_DEBUG((LM_DEBUG,"(%P|%t) monitor: SLEEPING BEFORE READING!\n")); ACE_OS::sleep (delay_before_read_sec); } ::DDS::Subscriber_var bit_subscriber = participant->get_builtin_subscriber () ; ::DDS::DataReader_var reader = bit_subscriber->lookup_datareader (OpenDDS::DCPS::BUILT_IN_PARTICIPANT_TOPIC) ; ::DDS::ParticipantBuiltinTopicDataDataReader_var part_reader = ::DDS::ParticipantBuiltinTopicDataDataReader::_narrow (reader.in ()); if (CORBA::is_nil (part_reader.in ())) { ACE_ERROR((LM_ERROR, "(%P|%t) monitor: failed to get BUILT_IN_PARTICIPANT_TOPIC datareader.\n")); return 1; } reader = bit_subscriber->lookup_datareader (OpenDDS::DCPS::BUILT_IN_TOPIC_TOPIC); ::DDS::TopicBuiltinTopicDataDataReader_var topic_reader = ::DDS::TopicBuiltinTopicDataDataReader::_narrow (reader.in ()); if (CORBA::is_nil (topic_reader.in ())) { ACE_ERROR((LM_ERROR, "(%P|%t) monitor: failed to get BUILT_IN_TOPIC_TOPIC datareader.\n")); return 1; } reader = bit_subscriber->lookup_datareader (OpenDDS::DCPS::BUILT_IN_SUBSCRIPTION_TOPIC) ; ::DDS::SubscriptionBuiltinTopicDataDataReader_var sub_reader = ::DDS::SubscriptionBuiltinTopicDataDataReader::_narrow (reader.in ()); if (CORBA::is_nil (sub_reader.in ())) { ACE_ERROR((LM_ERROR, "(%P|%t) monitor: failed to get BUILT_IN_SUBSCRIPTION_TOPIC datareader.\n")); return 1; } reader = bit_subscriber->lookup_datareader (OpenDDS::DCPS::BUILT_IN_PUBLICATION_TOPIC) ; ::DDS::PublicationBuiltinTopicDataDataReader_var pub_reader = ::DDS::PublicationBuiltinTopicDataDataReader::_narrow (reader.in ()); if (CORBA::is_nil (pub_reader.in ())) { ACE_ERROR((LM_ERROR, "(%P|%t) monitor: failed to get BUILT_IN_PUBLICATION_TOPIC datareader.\n")); return 1; } { ::DDS::InstanceHandleSeq handles; if (participant->get_discovered_participants (handles) != ::DDS::RETCODE_OK || handles.length () == 0) { ACE_ERROR((LM_ERROR, "(%P|%t) monitor: get_discovered_participant test failed.\n")); return 1; } CORBA::ULong len = handles.length (); if (len != num_parts - 1) { ACE_ERROR_RETURN ((LM_ERROR, "(%P|%t) monitor: get_discovered_participant expected %d got %d.\n", num_parts, len), 1); } for (CORBA::ULong i = 0; i < len; ++ i) { ACE_DEBUG((LM_DEBUG, ACE_TEXT("(%P|%t) monitor: participant %d examining participant handle %d.\n"), participant->get_instance_handle(), handles[i] )); ::DDS::ParticipantBuiltinTopicData data; participant->get_discovered_participant_data(data, handles[i]); OpenDDS::DCPS::RepoId id = OpenDDS::DCPS::RepoIdBuilder::create(); OpenDDS::DCPS::RepoIdBuilder builder( id); builder.from_BuiltinTopicKey( data.key); if (part_svt->get_handle (id) != handles[i]) { ACE_ERROR((LM_ERROR, "(%P|%t) monitor: get_discovered_participant_data test failed.\n")); return 1; } } if (participant->ignore_participant (handles[0]) != ::DDS::RETCODE_OK) { ACE_ERROR((LM_ERROR, "(%P|%t) monitor: ignore_participant failed.\n")); return 1; } handles.length (0); if (participant->get_discovered_participants (handles) != ::DDS::RETCODE_OK || handles.length () != num_parts - 2) { ACE_ERROR((LM_ERROR, ACE_TEXT ("(%P|%t) monitor: get_discovered_participant ") ACE_TEXT ("skip ignored participant test failed.\n"))); return 1; } ACE_DEBUG((LM_DEBUG, "(%P|%t) monitor: discover participants test PASSED.\n")); } ::DDS::SampleInfoSeq partinfos(10); ::DDS::ParticipantBuiltinTopicDataSeq partdata(10); ::DDS::ReturnCode_t ret = part_reader->read (partdata, partinfos, 10, ::DDS::ANY_SAMPLE_STATE, ::DDS::ANY_VIEW_STATE, ::DDS::ANY_INSTANCE_STATE); if (ret != ::DDS::RETCODE_OK && ret != ::DDS::RETCODE_NO_DATA) { ACE_ERROR_RETURN ((LM_ERROR, "(%P|%t) monitor: failed to read BIT participant data.\n"), 1); } CORBA::ULong len = partdata.length (); if (len != num_parts) { ACE_ERROR_RETURN ((LM_ERROR, "(%P|%t) monitor: read %d BIT part data, expected %d parts.\n", len, num_parts), 1); } CORBA::ULong cur_dps_with_user_data = 0; CORBA::ULong user_data_len = static_cast<CORBA::ULong>(ACE_OS::strlen (CUR_PART_USER_DATA)); for (CORBA::ULong i = 0; i < len; ++i) { ACE_DEBUG((LM_DEBUG, "(%P|%t) monitor: Participant: key = %d, %x, %x \n", partdata[i].key.value[0], partdata[i].key.value[1], partdata[i].key.value[2])); CORBA::ULong cur_len = partdata[i].user_data.value.length (); if ((cur_len == user_data_len) && (ACE_OS::strncmp (reinterpret_cast <char*> (partdata[i].user_data.value.get_buffer()), CUR_PART_USER_DATA, user_data_len) == 0)) { ++cur_dps_with_user_data; } } if (cur_dps_with_user_data == dps_with_user_data) { ACE_DEBUG((LM_DEBUG, "(%P|%t) monitor: DomainParticipant changeable qos test PASSED.\n")); } else { ACE_ERROR_RETURN ((LM_ERROR, "(%P|%t) monitor: DomainParticipant changeable qos test FAILED.\n"), 1); } { ::DDS::InstanceHandleSeq handles; if (participant->get_discovered_topics (handles) != ::DDS::RETCODE_OK || handles.length () == 0) { ACE_ERROR((LM_ERROR, "(%P|%t) monitor: get_discovered_topics test failed.\n")); return 1; } CORBA::ULong len = handles.length (); if (len != num_topics) { ACE_ERROR_RETURN ((LM_ERROR, "(%P|%t) monitor: get_discovered_topics expected %d got %d.\n", num_topics, len), 1); } for (CORBA::ULong i = 0; i < len; ++ i) { ::DDS::TopicBuiltinTopicData data; participant->get_discovered_topic_data(data, handles[i]); OpenDDS::DCPS::RepoId id = OpenDDS::DCPS::RepoIdBuilder::create(); OpenDDS::DCPS::RepoIdBuilder builder( id); builder.from_BuiltinTopicKey( data.key); if (part_svt->get_handle (id) != handles[i]) { ACE_ERROR((LM_ERROR, "(%P|%t) monitor: get_discovered_topic_data test failed.\n")); return 1; } } if (participant->ignore_topic (handles[0]) != ::DDS::RETCODE_OK) { ACE_ERROR((LM_ERROR, "(%P|%t) monitor: ignore_topic failed.\n")); return 1; } handles.length (0); if (participant->get_discovered_topics (handles) != ::DDS::RETCODE_OK || handles.length () != num_parts - 2) { ACE_ERROR((LM_ERROR, ACE_TEXT ("(%P|%t) monitor: get_discovered_topics ") ACE_TEXT ("skip ignored topic test failed.\n"))); return 1; } ACE_DEBUG((LM_DEBUG, "(%P|%t) monitor: discover topics test PASSED.\n")); } ::DDS::SampleInfoSeq topicinfos(10); ::DDS::TopicBuiltinTopicDataSeq topicdata(10); ret = topic_reader->read (topicdata, topicinfos, 10, ::DDS::ANY_SAMPLE_STATE, ::DDS::ANY_VIEW_STATE, ::DDS::ANY_INSTANCE_STATE); if (ret != ::DDS::RETCODE_OK && ret != ::DDS::RETCODE_NO_DATA) { ACE_ERROR_RETURN ((LM_ERROR, "(%P|%t) monitor: failed to read BIT topic data.\n"), 1); } len = topicdata.length (); if (len != num_topics) { ACE_ERROR_RETURN ((LM_ERROR, "(%P|%t) monitor: read %d BIT topic data, expected %d topics.\n", len, num_topics), 1); } CORBA::ULong num_topics_with_data = 0; for (CORBA::ULong i = 0; i < len; ++i) { if (ACE_OS::strcmp (topicdata[i].name.in (), topic_name) != 0) { ACE_ERROR_RETURN ((LM_ERROR, "(%P|%t) monitor: got topic name \"%C\", expected topic name \"%C\"\n", topicdata[i].name.in (), topic_name), 1); } if (ACE_OS::strcmp (topicdata[i].type_name.in (), topic_type_name) != 0) { ACE_ERROR_RETURN ((LM_ERROR, "(%P|%t) monitor: got topic type name \"%C\", expected topic type name \"%C\"\n", topicdata[i].type_name.in (), topic_type_name), 1); } ACE_DEBUG((LM_DEBUG, "(%P|%t) monitor: Topic: key = %d, %x, %x, name = %C, " "type_name=%C \n", topicdata[i].key.value[0], topicdata[i].key.value[1], topicdata[i].key.value[2], topicdata[i].name.in (), topicdata[i].type_name.in ())); CORBA::ULong topic_data_len = static_cast<CORBA::ULong>(ACE_OS::strlen (CUR_TOPIC_DATA)); if ((topicdata[i].topic_data.value.length () == topic_data_len) && (ACE_OS::strncmp (reinterpret_cast <char*> (topicdata[i].topic_data.value.get_buffer()), CUR_TOPIC_DATA, topic_data_len) == 0)) { ++ num_topics_with_data; } } if (num_topics_with_data == num_topics) { ACE_DEBUG((LM_DEBUG, "(%P|%t) monitor: Topic changeable qos test PASSED. \n")); } else { ACE_ERROR_RETURN ((LM_ERROR, "(%P|%t) monitor: Topic changeable qos test FAILED. \n"), 1); } ::DDS::SampleInfoSeq pubinfos(10); ::DDS::PublicationBuiltinTopicDataSeq pubdata(10); ret = pub_reader->read (pubdata, pubinfos, 10, ::DDS::ANY_SAMPLE_STATE, ::DDS::ANY_VIEW_STATE, ::DDS::ANY_INSTANCE_STATE); if (ret != ::DDS::RETCODE_OK && ret != ::DDS::RETCODE_NO_DATA) { ACE_ERROR_RETURN ((LM_ERROR, "(%P|%t) monitor: failed to read BIT publication data.\n"), 1); } len = pubdata.length (); if (len != num_pubs) { ACE_ERROR_RETURN ((LM_ERROR, "(%P|%t) monitor: read %d BIT pub data, expected %d pubs.\n", len, num_pubs), 1); } CORBA::ULong num_dws_with_data = 0; for (CORBA::ULong i = 0; i < len; ++i) { if (ACE_OS::strcmp (pubdata[i].topic_name.in (), topic_name) != 0) { ACE_ERROR_RETURN ((LM_ERROR, "(%P|%t) monitor: got datawriter topic name \"%C\", expected topic name \"%C\"\n", pubdata[i].topic_name.in (), topic_name), 1); } if (ACE_OS::strcmp (pubdata[i].type_name.in (), topic_type_name) != 0) { ACE_ERROR_RETURN ((LM_ERROR, "(%P|%t) monitor: got datawriter topic type name \"%C\", expected topic type name \"%C\"\n", pubdata[i].type_name.in (), topic_type_name), 1); } ACE_DEBUG((LM_DEBUG, "(%P|%t) monitor: DataWriter: key = %d, %x, %x. \n", pubdata[i].key.value[0], pubdata[i].key.value[1], pubdata[i].key.value[2])); //ACE_DEBUG((LM_DEBUG, "(%P|%t) monitor: DW user data %C \n", pubdata[i].user_data.value.get_buffer())); //ACE_DEBUG((LM_DEBUG, "(%P|%t) monitor: DW topic data %C \n", pubdata[i].topic_data.value.get_buffer())); //ACE_DEBUG((LM_DEBUG, "(%P|%t) monitor: DW group data %C \n", pubdata[i].group_data.value.get_buffer())); CORBA::ULong user_data_len = static_cast<CORBA::ULong>(ACE_OS::strlen (CUR_DW_USER_DATA)); CORBA::ULong topic_data_len = static_cast<CORBA::ULong>(ACE_OS::strlen (CUR_TOPIC_DATA)); CORBA::ULong group_data_len = static_cast<CORBA::ULong>(ACE_OS::strlen (CUR_GROUP_DATA)); if (pubdata[i].user_data.value.length () == user_data_len && pubdata[i].topic_data.value.length () == topic_data_len && pubdata[i].group_data.value.length () == group_data_len) { if (ACE_OS::strncmp (reinterpret_cast <char*> (pubdata[i].user_data.value.get_buffer()), CUR_DW_USER_DATA, user_data_len) == 0 && ACE_OS::strncmp (reinterpret_cast <char*> (pubdata[i].topic_data.value.get_buffer()), CUR_TOPIC_DATA, topic_data_len) == 0 && ACE_OS::strncmp (reinterpret_cast <char*> (pubdata[i].group_data.value.get_buffer()), CUR_GROUP_DATA, group_data_len) == 0) { ++ num_dws_with_data; } } } if (num_dws_with_data == num_pubs) { ACE_DEBUG((LM_DEBUG, "(%P|%t) monitor: DataWriter changeable qos test PASSED. \n")); } else { ACE_ERROR_RETURN ((LM_ERROR, "(%P|%t) monitor: DataWriter changeable qos test FAILED. \n"), 1); } ::DDS::SampleInfoSeq subinfos(10); ::DDS::SubscriptionBuiltinTopicDataSeq subdata(10); ret = sub_reader->read (subdata, subinfos, 10, ::DDS::ANY_SAMPLE_STATE, ::DDS::ANY_VIEW_STATE, ::DDS::ANY_INSTANCE_STATE); if (ret != ::DDS::RETCODE_OK && ret != ::DDS::RETCODE_NO_DATA) { ACE_ERROR_RETURN ((LM_ERROR, "(%P|%t) monitor: failed to read BIT subsciption data.\n"), 1); } len = subdata.length (); if (len != num_subs) { ACE_ERROR_RETURN ((LM_ERROR, "(%P|%t) monitor: read %d BIT sub data, expected %d subs.\n", len, num_subs), 1); } CORBA::ULong num_drs_with_data = 0; for (CORBA::ULong i = 0; i < len; ++i) { if (ACE_OS::strcmp (subdata[i].topic_name.in (), topic_name) != 0) { ACE_ERROR_RETURN ((LM_ERROR, "(%P|%t) monitor: got datareader topic name \"%C\", expected topic name \"%C\"\n", subdata[i].topic_name.in (), topic_name), 1); } if (ACE_OS::strcmp (subdata[i].type_name.in (), topic_type_name) != 0) { ACE_ERROR_RETURN ((LM_ERROR, "(%P|%t) monitor: got datareader topic type name \"%C\", expected topic type name \"%C\"\n", subdata[i].type_name.in (), topic_type_name), 1); } ACE_DEBUG((LM_DEBUG, "(%P|%t) monitor: DataReader: key = %d, %x, %x \n", subdata[i].key.value[0], subdata[i].key.value[1], subdata[i].key.value[2])); //ACE_DEBUG((LM_DEBUG, "(%P|%t) DR user data %C \n", subdata[i].user_data.value.get_buffer())); //ACE_DEBUG((LM_DEBUG, "(%P|%t) DR topic data %C \n", subdata[i].topic_data.value.get_buffer())); //ACE_DEBUG((LM_DEBUG, "(%P|%t) DR group data %C \n", subdata[i].group_data.value.get_buffer())); CORBA::ULong user_data_len = static_cast<CORBA::ULong>(ACE_OS::strlen (CUR_DR_USER_DATA)); CORBA::ULong topic_data_len = static_cast<CORBA::ULong>(ACE_OS::strlen (CUR_TOPIC_DATA)); CORBA::ULong group_data_len = static_cast<CORBA::ULong>(ACE_OS::strlen (CUR_GROUP_DATA)); if (subdata[i].user_data.value.length () == user_data_len && subdata[i].topic_data.value.length () == topic_data_len && subdata[i].group_data.value.length () == group_data_len) { if (ACE_OS::strncmp (reinterpret_cast <char*> (subdata[i].user_data.value.get_buffer()), CUR_DR_USER_DATA, user_data_len) == 0 && ACE_OS::strncmp (reinterpret_cast <char*> (subdata[i].topic_data.value.get_buffer()), CUR_TOPIC_DATA, topic_data_len) == 0 && ACE_OS::strncmp (reinterpret_cast <char*> (subdata[i].group_data.value.get_buffer()), CUR_GROUP_DATA, group_data_len) == 0) { ++ num_drs_with_data; } } } if (num_drs_with_data == num_subs) { ACE_DEBUG((LM_DEBUG, "(%P|%t) monitor: DataReader changeable qos test PASSED. \n")); } else { ACE_ERROR_RETURN ((LM_ERROR, "(%P|%t) monitor: DataReader changeable qos test FAILED. \n"), 1); } dpf->delete_participant(participant.in ()); TheTransportFactory->release(); TheServiceParticipant->shutdown (); if (CUR_PART_USER_DATA == PART_USER_DATA) { // Create synch file. FILE* fp = ACE_OS::fopen (synch_fname, ACE_TEXT("w")); if (fp != 0) { ACE_DEBUG ((LM_DEBUG, ACE_TEXT("(%P|%t) monitor1 is done\n"))); ACE_OS::fclose (fp); } } } catch (CORBA::Exception& e) { cerr << " monitor: SUB: Exception caught in main ():" << endl << e << endl; return 1; } return 0; }