summaryrefslogtreecommitdiff
path: root/common/distrio_helper.cpp
blob: 2f499411d87e4c9052374c506915822d8887359a (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
/**
 * @author Manuel Traut <manut@mecka.net>
 * @licence GPLv2
 */

#include <iostream>
#include "distrio_helper.h"

int init_corba (int argc, char **argv)
{
	int ret = 0;
	CORBA::Object_var obj, root_poa, naming_service, manager_obj;
	CosNaming::Name name;

	try {
		ref.orb = CORBA::ORB_init (argc, argv);
		root_poa = ref.orb->resolve_initial_references ("RootPOA");
		ref.poa = PortableServer::POA::_narrow (root_poa.in ());

		naming_service = ref.orb->resolve_initial_references ("NameService");
		if (CORBA::is_nil (naming_service)) {
			std::cerr << "can't resolve NameService" << std::endl;
			ret = -EINVAL;
			goto out;
		}
		ref.nc = CosNaming::NamingContext::_narrow (naming_service.in ());
		if (CORBA::is_nil (ref.nc)) {
			std::cerr << "resolved invalid NameService object" << std::endl;
			ret = -EINVAL;
			goto out;
		}
		name.length (1);
		name[0].id = CORBA::string_dup ("distrio_manager");
		name[0].kind = CORBA::string_dup ("");
		manager_obj = ref.nc->resolve (name);
		if (CORBA::is_nil (manager_obj)) {
			std::cerr << "can't resolve distrio_manager @naming service" << std::endl;
			ret = -EINVAL;
			goto out;
		}
		ref.manager = Distrio::Manager::_narrow (manager_obj);
		if (CORBA::is_nil (ref.manager)) {
			std::cerr << "resolved invalid distrio_manager object" << std::endl;
			ret = -EINVAL;
			goto out;
		}
	} catch (CORBA::Exception &e) {
		std::cerr << "CORBA initialization failed: " << e << std::endl;
		ret = -EINVAL;
		goto out;
	}

	ref.init = ORB_INIT;

out:
	return ret;
}

int register_digital (std::string _name, Distrio_Digital_i *digital)
{
	CosNaming::Name name;
	CORBA::Object_var obj, manager_obj;
	PortableServer::ObjectId_var oid;
	Distrio::Digital_ptr ptr;
	Distrio::Error *e;

	if (ref.init != ORB_RUNNING) {
		std::cerr << "corba not initialized" << std::endl;
		return -1;
	}

	try {
		oid = ref.poa->activate_object (digital);
		obj = digital->_this ();
		name.length (1);
		name[0].id = CORBA::string_dup (_name.c_str ());
		name[0].kind = CORBA::string_dup ("digital_io");
		ref.nc->rebind (name, obj.in ());
	} catch (CORBA::Exception &e) {
		std::cerr << "CORBA bind digital io at naming service failed: "
			<< e << std::endl;
		return -1;
	}

	try {
		ptr = Distrio::Digital::_narrow (obj);
		e = ref.manager->register_io_digital (ptr);
		std::cout << e->description << std::endl;
		free (e);
	} catch (CORBA::Exception &_e) {
		std::cerr << "CORBA register digital io at distrio manager failed: "
			<< _e << std::endl;
		return -1;
	}

	return 0;
}

pthread_t orb_thread;

void *orb_runner (void *args)
{
	try {
		ref.poa_mgr = ref.poa->the_POAManager ();
		ref.poa_mgr->activate ();
		ref.orb->run ();
		ref.orb->destroy ();
	} catch (CORBA::Exception &e) {
		std::cerr << "run CORBA orb failed: " << e << std::endl;
	}
}

int run_orb ()
{
	if (ref.init != ORB_INIT) {
		std::cerr << "corba not initialized or orb already running" << std::endl;
		return -1;
	}

	if (pthread_create (&orb_thread, NULL, orb_runner, NULL)) {
		std::cerr << "create thread for corba orb failed" << std::endl;
		return -1;
	}

	ref.init = ORB_RUNNING;

	return 0;
}