#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 ;
}