summaryrefslogtreecommitdiff
path: root/digital/ai/tools/robospierre.py
blob: 09be4bea503fead41e44ed067269f1bb03471b5d (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
import simu.model.table_eurobot2011
import simu.view.table_eurobot2011

import simu.robots.robospierre.link.bag
import simu.robots.robospierre.model.bag
import simu.robots.robospierre.view.bag

import asserv
import asserv.init
import mimot
import mimot.init
import io_hub
import io_hub.init

from proto.popen_io import PopenIO
import math

class Robot:

    def __init__ (self, proto_time):
        self.table_model = simu.model.table_eurobot2011
        self.table_view = simu.view.table_eurobot2011
        self.robot_link = simu.robots.robospierre.link.bag
        self.robot_model = simu.robots.robospierre.model.bag
        self.robot_view = simu.robots.robospierre.view.bag
        asserv_cmd = ('../../asserv/src/asserv/asserv.host', '-m9', 'marcel')
        mimot_cmd = ('../../mimot/src/dirty/dirty.host', '-m9', 'marcel')
        io_hub_cmd = ('../../io-hub/src/robospierre/io_hub.host')
        self.asserv = asserv.Proto (PopenIO (asserv_cmd), proto_time,
                **asserv.init.host['robospierre'])
        self.mimot = mimot.Proto (PopenIO (mimot_cmd), proto_time,
                **mimot.init.host['robospierre'])
        self.io = io_hub.Proto (PopenIO (io_hub_cmd), proto_time,
                **io_hub.init.host['robospierre'])
        self.robot_start_pos = {
                False: (700, 2100 - 250, math.radians (-270)),
                True: (3000 - 700, 2100 - 250, math.radians (-270))
                }