mirror of
https://github.com/nasa/trick.git
synced 2024-12-21 06:03:10 +00:00
421 lines
15 KiB
C++
421 lines
15 KiB
C++
|
|
#include "sim_services/Message/include/message_proto.h"
|
|
#include "STLCheckpoint.hh"
|
|
|
|
/* These 2 constructors add different data to an STLCheckpoint. */
|
|
|
|
STLCheckpoint::STLCheckpoint() {
|
|
|
|
double_map[11.1] = 111.1 ;
|
|
double_map[22.2] = 222.2 ;
|
|
double_map[33.3] = 333.3 ;
|
|
|
|
string_key_map[std::string("one")] = 1 ;
|
|
string_key_map[std::string("two")] = 2 ; string_key_map[std::string("three")] = 3 ;
|
|
|
|
string_data_map[4] = std::string("vier") ;
|
|
string_data_map[5] = std::string("fumf") ;
|
|
string_data_map[6] = std::string("sechs") ;
|
|
|
|
string_map[std::string("mother")] = std::string("Marge") ;
|
|
string_map[std::string("father")] = std::string("Homer") ;
|
|
string_map[std::string("son")] = std::string("Bart") ;
|
|
|
|
int_multimap.insert(std::pair<int, int>(11,111)) ;
|
|
int_multimap.insert(std::pair<int, int>(22,222)) ;
|
|
int_multimap.insert(std::pair<int, int>(33,333)) ;
|
|
int_multimap.insert(std::pair<int, int>(11,111)) ;
|
|
int_multimap.insert(std::pair<int, int>(22,222)) ;
|
|
int_multimap.insert(std::pair<int, int>(33,333)) ;
|
|
|
|
string_key_multimap.insert(std::pair<std::string, int>("one", 1)) ;
|
|
string_key_multimap.insert(std::pair<std::string, int>("two", 2)) ;
|
|
string_key_multimap.insert(std::pair<std::string, int>("three", 3)) ;
|
|
string_key_multimap.insert(std::pair<std::string, int>("one", 1)) ;
|
|
string_key_multimap.insert(std::pair<std::string, int>("two", 2)) ;
|
|
string_key_multimap.insert(std::pair<std::string, int>("three", 3)) ;
|
|
|
|
string_data_multimap.insert(std::pair<int, std::string>(4, "vier")) ;
|
|
string_data_multimap.insert(std::pair<int, std::string>(5, "fumf")) ;
|
|
string_data_multimap.insert(std::pair<int, std::string>(6, "sechs")) ;
|
|
string_data_multimap.insert(std::pair<int, std::string>(4, "four")) ;
|
|
string_data_multimap.insert(std::pair<int, std::string>(5, "five")) ;
|
|
string_data_multimap.insert(std::pair<int, std::string>(6, "six")) ;
|
|
|
|
string_multimap.insert(std::pair<std::string, std::string>("mother","Marge")) ;
|
|
string_multimap.insert(std::pair<std::string, std::string>("father","Homer")) ;
|
|
string_multimap.insert(std::pair<std::string, std::string>("mother","Lois")) ;
|
|
string_multimap.insert(std::pair<std::string, std::string>("father","Meg")) ;
|
|
|
|
double_vector.push_back(1.0) ;
|
|
double_vector.push_back(2.0) ;
|
|
double_vector.push_back(3.0) ;
|
|
|
|
string_vector.push_back("I") ;
|
|
string_vector.push_back("was") ;
|
|
string_vector.push_back("here") ;
|
|
|
|
short_list.push_back(300) ;
|
|
short_list.push_back(301) ;
|
|
short_list.push_back(302) ;
|
|
|
|
string_list.push_back("I") ;
|
|
string_list.push_back("was") ;
|
|
string_list.push_back("there") ;
|
|
|
|
float_deque.push_back(12.3) ;
|
|
float_deque.push_back(45.6) ;
|
|
float_deque.push_back(78.9) ;
|
|
|
|
string_deque.push_back("meow") ;
|
|
string_deque.push_back("bark") ;
|
|
string_deque.push_back("quack") ;
|
|
|
|
int_set.insert(8) ;
|
|
int_set.insert(4) ;
|
|
int_set.insert(2) ;
|
|
int_set.insert(1) ;
|
|
|
|
string_set.insert("e") ;
|
|
string_set.insert("a") ;
|
|
string_set.insert("d") ;
|
|
|
|
long_multiset.insert(8) ;
|
|
long_multiset.insert(4) ;
|
|
long_multiset.insert(4) ;
|
|
long_multiset.insert(2) ;
|
|
long_multiset.insert(1) ;
|
|
|
|
string_multiset.insert("e") ;
|
|
string_multiset.insert("a") ;
|
|
string_multiset.insert("d") ;
|
|
string_multiset.insert("e") ;
|
|
string_multiset.insert("a") ;
|
|
string_multiset.insert("d") ;
|
|
|
|
uint_stack.push(10) ;
|
|
uint_stack.push(20) ;
|
|
uint_stack.push(30) ;
|
|
uint_stack.push(40) ;
|
|
|
|
string_stack.push("abc I") ;
|
|
string_stack.push("abc want the one") ;
|
|
string_stack.push("abc with the bigger") ;
|
|
string_stack.push("abc Gee Bees") ;
|
|
|
|
int_queue.push(10) ;
|
|
int_queue.push(20) ;
|
|
int_queue.push(30) ;
|
|
int_queue.push(40) ;
|
|
|
|
string_queue.push("abc I") ;
|
|
string_queue.push("abc want") ;
|
|
string_queue.push("abc an") ;
|
|
string_queue.push("abc iPhone 4") ;
|
|
|
|
int_priority_queue.push(30) ;
|
|
int_priority_queue.push(20) ;
|
|
int_priority_queue.push(40) ;
|
|
int_priority_queue.push(10) ;
|
|
|
|
string_priority_queue.push("abc I") ;
|
|
string_priority_queue.push("abc want") ;
|
|
string_priority_queue.push("abc an") ;
|
|
string_priority_queue.push("abc iPhone 4") ;
|
|
|
|
int_pair.first = 1 ;
|
|
int_pair.second = 2 ;
|
|
|
|
string_first_pair.first = "abc string first" ;
|
|
string_first_pair.second = 2 ;
|
|
|
|
string_second_pair.first = 2 ;
|
|
string_second_pair.second = "abc string second" ;
|
|
|
|
string_pair.first = "abc pair first string" ;
|
|
string_pair.second = "abc pair second string" ;
|
|
return ;
|
|
}
|
|
|
|
STLCheckpoint::STLCheckpoint(std::string in_name) :
|
|
vector_vector_double(4, std::vector<double>(3)) ,
|
|
vector_vector_vector_double(5, std::vector<std::vector<double> >(4, std::vector<double>(3)))
|
|
{
|
|
|
|
name = in_name ;
|
|
|
|
double_map[44.4] = 444.4 ;
|
|
double_map[55.5] = 555.5 ;
|
|
double_map[66.6] = 666.6 ;
|
|
|
|
string_key_map[std::string("four")] = 4 ;
|
|
string_key_map[std::string("five")] = 5 ;
|
|
string_key_map[std::string("six")] = 6 ;
|
|
|
|
string_data_map[7] = std::string("seiben") ;
|
|
string_data_map[8] = std::string("acht") ;
|
|
string_data_map[9] = std::string("neun") ;
|
|
|
|
std::vector< int > v ;
|
|
v.push_back(2) ;
|
|
v.push_back(4) ;
|
|
v.push_back(6) ;
|
|
v.push_back(8) ;
|
|
map_int_vector_int[1] = v ;
|
|
|
|
std::pair< int , int > p ;
|
|
p.first = 24 ;
|
|
p.second = 30 ;
|
|
gcd[p] = 6 ;
|
|
|
|
p.first = 50 ;
|
|
p.second = 60 ;
|
|
std::pair< int , int > q ;
|
|
q.first = 70 ;
|
|
q.second = 80 ;
|
|
map_pair_pair[p] = q ;
|
|
|
|
p.first = 3 ;
|
|
p.second = 5 ;
|
|
v.clear() ;
|
|
v.push_back(15) ;
|
|
v.push_back(30) ;
|
|
v.push_back(45) ;
|
|
v.push_back(60) ;
|
|
common_multiples.insert(std::pair< std::pair< int, int >, std::vector< int > >(p,v)) ;
|
|
|
|
string_map[std::string("sister")] = std::string("Lisa") ;
|
|
string_map[std::string("dog")] = std::string("Santa's Little Helper") ;
|
|
|
|
int_multimap.insert(std::pair<int, int>(44,444)) ;
|
|
int_multimap.insert(std::pair<int, int>(55,555)) ;
|
|
int_multimap.insert(std::pair<int, int>(66,666)) ;
|
|
int_multimap.insert(std::pair<int, int>(44,444)) ;
|
|
int_multimap.insert(std::pair<int, int>(55,555)) ;
|
|
int_multimap.insert(std::pair<int, int>(66,666)) ;
|
|
|
|
string_key_multimap.insert(std::pair<std::string, int>("four", 4)) ;
|
|
string_key_multimap.insert(std::pair<std::string, int>("five", 5)) ;
|
|
string_key_multimap.insert(std::pair<std::string, int>("six", 6)) ;
|
|
string_key_multimap.insert(std::pair<std::string, int>("four", 44)) ;
|
|
string_key_multimap.insert(std::pair<std::string, int>("five", 55)) ;
|
|
string_key_multimap.insert(std::pair<std::string, int>("six", 66)) ;
|
|
|
|
string_data_multimap.insert(std::pair<int, std::string>(7, "seiben")) ;
|
|
string_data_multimap.insert(std::pair<int, std::string>(8, "acht")) ;
|
|
string_data_multimap.insert(std::pair<int, std::string>(9, "neun")) ;
|
|
string_data_multimap.insert(std::pair<int, std::string>(7, "seven")) ;
|
|
string_data_multimap.insert(std::pair<int, std::string>(8, "eight")) ;
|
|
string_data_multimap.insert(std::pair<int, std::string>(9, "nine")) ;
|
|
|
|
string_multimap.insert(std::pair<std::string, std::string>("sister","Lisa")) ;
|
|
string_multimap.insert(std::pair<std::string, std::string>("dog","Santa's Little Helper")) ;
|
|
string_multimap.insert(std::pair<std::string, std::string>("sister","Meg")) ;
|
|
string_multimap.insert(std::pair<std::string, std::string>("dog","Brian")) ;
|
|
|
|
double_vector.push_back(4.0) ;
|
|
double_vector.push_back(5.0) ;
|
|
double_vector.push_back(6.0) ;
|
|
|
|
string_vector.push_back("It") ;
|
|
string_vector.push_back("has") ;
|
|
string_vector.push_back("the") ;
|
|
string_vector.push_back("Wi-Fies") ;
|
|
|
|
short_list.push_back(400) ;
|
|
short_list.push_back(401) ;
|
|
short_list.push_back(402) ;
|
|
|
|
string_list.push_back("I") ;
|
|
string_list.push_back("don't") ;
|
|
string_list.push_back("care") ;
|
|
|
|
float_deque.push_back(98.7) ;
|
|
float_deque.push_back(65.4) ;
|
|
float_deque.push_back(32.1) ;
|
|
|
|
string_deque.push_back("Welcome") ;
|
|
string_deque.push_back("to") ;
|
|
string_deque.push_back("PhoneMart") ;
|
|
|
|
int_set.insert(8000) ;
|
|
int_set.insert(4000) ;
|
|
int_set.insert(2000) ;
|
|
int_set.insert(1000) ;
|
|
|
|
string_set.insert("efg") ;
|
|
string_set.insert("abc") ;
|
|
string_set.insert("def") ;
|
|
|
|
long_multiset.insert(8000) ;
|
|
long_multiset.insert(4000) ;
|
|
long_multiset.insert(4000) ;
|
|
long_multiset.insert(2000) ;
|
|
long_multiset.insert(1000) ;
|
|
|
|
string_multiset.insert("efg") ;
|
|
string_multiset.insert("abc") ;
|
|
string_multiset.insert("def") ;
|
|
string_multiset.insert("efg") ;
|
|
string_multiset.insert("abc") ;
|
|
string_multiset.insert("def") ;
|
|
|
|
uint_stack.push(1) ;
|
|
uint_stack.push(2) ;
|
|
uint_stack.push(3) ;
|
|
uint_stack.push(4) ;
|
|
|
|
string_stack.push("I") ;
|
|
string_stack.push("want the one") ;
|
|
string_stack.push("with the bigger") ;
|
|
string_stack.push("Gee Bees") ;
|
|
|
|
int_queue.push(1) ;
|
|
int_queue.push(2) ;
|
|
int_queue.push(3) ;
|
|
int_queue.push(4) ;
|
|
|
|
string_queue.push("I") ;
|
|
string_queue.push("want") ;
|
|
string_queue.push("an") ;
|
|
string_queue.push("iPhone 4") ;
|
|
|
|
int_priority_queue.push(3) ;
|
|
int_priority_queue.push(2) ;
|
|
int_priority_queue.push(4) ;
|
|
int_priority_queue.push(1) ;
|
|
|
|
string_priority_queue.push("I") ;
|
|
string_priority_queue.push("want") ;
|
|
string_priority_queue.push("an") ;
|
|
string_priority_queue.push("iPhone 4") ;
|
|
|
|
int_pair.first = 10 ;
|
|
int_pair.second = 20 ;
|
|
|
|
string_first_pair.first = "string first" ;
|
|
string_first_pair.second = 25 ;
|
|
|
|
string_second_pair.first = 25 ;
|
|
string_second_pair.second = "string second" ;
|
|
|
|
string_pair.first = "pair first string" ;
|
|
string_pair.second = "pair second string" ;
|
|
|
|
int_pair_int_int.first = 200 ;
|
|
p.first = 10 ;
|
|
p.second = 20 ;
|
|
int_pair_int_int.second = p ;
|
|
|
|
p.first = 15 ;
|
|
p.second = 12 ;
|
|
pair_int_int_int.first = p ;
|
|
pair_int_int_int.second = 180 ;
|
|
|
|
pair_pair_pair.first.first = 51 ;
|
|
pair_pair_pair.first.second = 52 ;
|
|
pair_pair_pair.second.first = 53 ;
|
|
pair_pair_pair.second.second = 54 ;
|
|
|
|
vector_vector_double[0][0] = 100 ;
|
|
vector_vector_double[0][1] = 101 ;
|
|
vector_vector_double[0][2] = 102 ;
|
|
vector_vector_double[1][0] = 103 ;
|
|
vector_vector_double[1][1] = 104 ;
|
|
vector_vector_double[1][2] = 105 ;
|
|
vector_vector_double[2][0] = 106 ;
|
|
vector_vector_double[2][1] = 107 ;
|
|
vector_vector_double[2][2] = 108 ;
|
|
vector_vector_double[3][0] = 109 ;
|
|
vector_vector_double[3][1] = 110 ;
|
|
vector_vector_double[3][2] = 111 ;
|
|
|
|
vector_vector_vector_double[0][0][0] = 0 ;
|
|
vector_vector_vector_double[0][0][1] = 1 ;
|
|
vector_vector_vector_double[0][0][2] = 2 ;
|
|
vector_vector_vector_double[0][1][0] = 3 ;
|
|
vector_vector_vector_double[0][1][1] = 4 ;
|
|
vector_vector_vector_double[0][1][2] = 5 ;
|
|
vector_vector_vector_double[0][2][0] = 6 ;
|
|
vector_vector_vector_double[0][2][1] = 7 ;
|
|
vector_vector_vector_double[0][2][2] = 8 ;
|
|
vector_vector_vector_double[0][3][0] = 9 ;
|
|
vector_vector_vector_double[0][3][1] = 10 ;
|
|
vector_vector_vector_double[0][3][2] = 11 ;
|
|
|
|
vector_vector_vector_double[1][0][0] = 1000 ;
|
|
vector_vector_vector_double[1][0][1] = 1001 ;
|
|
vector_vector_vector_double[1][0][2] = 1002 ;
|
|
vector_vector_vector_double[1][1][0] = 1003 ;
|
|
vector_vector_vector_double[1][1][1] = 1004 ;
|
|
vector_vector_vector_double[1][1][2] = 1005 ;
|
|
vector_vector_vector_double[1][2][0] = 1006 ;
|
|
vector_vector_vector_double[1][2][1] = 1007 ;
|
|
vector_vector_vector_double[1][2][2] = 1008 ;
|
|
vector_vector_vector_double[1][3][0] = 1009 ;
|
|
vector_vector_vector_double[1][3][1] = 1010 ;
|
|
vector_vector_vector_double[1][3][2] = 1011 ;
|
|
|
|
vector_vector_vector_double[2][0][0] = 2000 ;
|
|
vector_vector_vector_double[2][0][1] = 2001 ;
|
|
vector_vector_vector_double[2][0][2] = 2002 ;
|
|
vector_vector_vector_double[2][1][0] = 2003 ;
|
|
vector_vector_vector_double[2][1][1] = 2004 ;
|
|
vector_vector_vector_double[2][1][2] = 2005 ;
|
|
vector_vector_vector_double[2][2][0] = 2006 ;
|
|
vector_vector_vector_double[2][2][1] = 2007 ;
|
|
vector_vector_vector_double[2][2][2] = 2008 ;
|
|
vector_vector_vector_double[2][3][0] = 2009 ;
|
|
vector_vector_vector_double[2][3][1] = 2010 ;
|
|
vector_vector_vector_double[2][3][2] = 2011 ;
|
|
|
|
vector_vector_vector_double[3][0][0] = 3000 ;
|
|
vector_vector_vector_double[3][0][1] = 3001 ;
|
|
vector_vector_vector_double[3][0][2] = 3002 ;
|
|
vector_vector_vector_double[3][1][0] = 3003 ;
|
|
vector_vector_vector_double[3][1][1] = 3004 ;
|
|
vector_vector_vector_double[3][1][2] = 3005 ;
|
|
vector_vector_vector_double[3][2][0] = 3006 ;
|
|
vector_vector_vector_double[3][2][1] = 3007 ;
|
|
vector_vector_vector_double[3][2][2] = 3008 ;
|
|
vector_vector_vector_double[3][3][0] = 3009 ;
|
|
vector_vector_vector_double[3][3][1] = 3010 ;
|
|
vector_vector_vector_double[3][3][2] = 3011 ;
|
|
|
|
vector_vector_vector_double[4][0][0] = 4000 ;
|
|
vector_vector_vector_double[4][0][1] = 4001 ;
|
|
vector_vector_vector_double[4][0][2] = 4002 ;
|
|
vector_vector_vector_double[4][1][0] = 4003 ;
|
|
vector_vector_vector_double[4][1][1] = 4004 ;
|
|
vector_vector_vector_double[4][1][2] = 4005 ;
|
|
vector_vector_vector_double[4][2][0] = 4006 ;
|
|
vector_vector_vector_double[4][2][1] = 4007 ;
|
|
vector_vector_vector_double[4][2][2] = 4008 ;
|
|
vector_vector_vector_double[4][3][0] = 4009 ;
|
|
vector_vector_vector_double[4][3][1] = 4010 ;
|
|
vector_vector_vector_double[4][3][2] = 4011 ;
|
|
|
|
return ;
|
|
}
|
|
|
|
int STLCheckpoint::speak() {
|
|
//message_publish(1,"Quack!\n") ;
|
|
//message_publish(1,"double_vector: %f %f %f\n", double_vector[0], double_vector[1], double_vector[2]) ;
|
|
//message_publish(1,"vector_vector_double[1]: %f %f %f\n",
|
|
// vector_vector_double[1][0], vector_vector_double[1][1], vector_vector_double[1][2]) ;
|
|
//message_publish(1,"vector_vector_vector_double[4][2]: %f %f %f\n",
|
|
// vector_vector_vector_double[4][2][0], vector_vector_vector_double[4][2][1], vector_vector_vector_double[4][2][2]) ;
|
|
//message_publish(1,"string_vector[0]: %s\n", string_vector[0].c_str()) ;
|
|
//message_publish(1,"map_int_vector_int[1][1] = %d\n", map_int_vector_int[1][1]) ;
|
|
//message_publish(1,"gcd = %d\n", gcd[std::pair<int, int >(24,30)]) ;
|
|
//message_publish(1,"common_multiples = %d\n", common_multiples[std::pair<int, int >(3,5)][1]) ;
|
|
//message_publish(1,"common_multiples = %d\n", common_multiples[std::pair<int, int >(3,5)][1]) ;
|
|
//message_publish(1,"int_pair_int_int.second.second = %d\n", int_pair_int_int.second.second) ;
|
|
//message_publish(1,"pair_int_int_int.first.second = %d\n", pair_int_int_int.first.second) ;
|
|
//message_publish(1,"pair_pair_pair.second.first = %d\n", pair_pair_pair.second.first) ;
|
|
message_publish(1,"int_queue.front = %d\n", int_queue.front()) ;
|
|
message_publish(1,"int_priority_queue.top = %d\n", int_priority_queue.top()) ;
|
|
return 0 ;
|
|
}
|
|
|