summaryrefslogtreecommitdiff
path: root/digital/io-hub/src/robospierre/bot.h
blob: e014321e91d95c23ccb1aed3feca667b7c5a08ff (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
#ifndef bot_h
#define bot_h
/* bot.h */
/* robospierre - Eurobot 2011 AI. {{{
 *
 * Copyright (C) 2011 Nicolas Schodet
 *
 * APBTeam:
 *        Web: http://apbteam.org/
 *      Email: team AT apbteam DOT org
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
 *
 * }}} */

/** Robot specific defines. */

/** Scaling factor, millimeter per step. */
#ifdef HOST
# define BOT_SCALE 0.0395840674352314
#else
# define BOT_SCALE 0.0415178942124
#endif

#ifdef HOST

# define BOT_CLAMP_SLOT_FRONT_BOTTOM_ELEVATION_STEP 0
# define BOT_CLAMP_SLOT_FRONT_MIDDLE_ELEVATION_STEP (0x3b0b / 2)
# define BOT_CLAMP_SLOT_FRONT_TOP_ELEVATION_STEP 0x3b0b
# define BOT_CLAMP_SLOT_BACK_BOTTOM_ELEVATION_STEP 0
# define BOT_CLAMP_SLOT_BACK_MIDDLE_ELEVATION_STEP (0x3b0b / 2)
# define BOT_CLAMP_SLOT_BACK_TOP_ELEVATION_STEP 0x3b0b
# define BOT_CLAMP_SLOT_SIDE_ELEVATION_STEP 0x3b0b
# define BOT_CLAMP_BAY_FRONT_LEAVE_ELEVATION_STEP (0x3b0b / 3)
# define BOT_CLAMP_BAY_BACK_LEAVE_ELEVATION_STEP (0x3b0b / 3)
# define BOT_CLAMP_BAY_SIDE_ENTER_LEAVE_ELEVATION_STEP (0x3b0b / 2)

# define BOT_CLAMP_BAY_FRONT_ROTATION_STEP 0
# define BOT_CLAMP_BAY_BACK_ROTATION_STEP 0x11c6
# define BOT_CLAMP_BAY_SIDE_ROTATION_STEP (0x11c6 / 2)

#else /* !HOST */

# define BOT_CLAMP_SLOT_FRONT_BOTTOM_ELEVATION_STEP 0
# define BOT_CLAMP_SLOT_FRONT_MIDDLE_ELEVATION_STEP 0x1d83
# define BOT_CLAMP_SLOT_FRONT_TOP_ELEVATION_STEP 0x3288
# define BOT_CLAMP_SLOT_BACK_BOTTOM_ELEVATION_STEP 0
# define BOT_CLAMP_SLOT_BACK_MIDDLE_ELEVATION_STEP 0x1d83
# define BOT_CLAMP_SLOT_BACK_TOP_ELEVATION_STEP 0x3288
# define BOT_CLAMP_SLOT_SIDE_ELEVATION_STEP 0x3288
# define BOT_CLAMP_BAY_FRONT_LEAVE_ELEVATION_STEP 0x1d83
# define BOT_CLAMP_BAY_BACK_LEAVE_ELEVATION_STEP 0x1d83
# define BOT_CLAMP_BAY_SIDE_ENTER_LEAVE_ELEVATION_STEP 0x1d83

# define BOT_CLAMP_BAY_FRONT_ROTATION_STEP 0
# define BOT_CLAMP_BAY_BACK_ROTATION_STEP 0x10e2
# define BOT_CLAMP_BAY_SIDE_ROTATION_STEP 0x820

#endif /* !HOST */

#define BOT_CLAMP_ELEVATION_SPEED 0x60
#define BOT_CLAMP_ROTATION_SPEED 0x30

#define BOT_PWM_CLAMP 2
#define BOT_PWM_DOOR_FRONT_BOTTOM 0
#define BOT_PWM_DOOR_FRONT_TOP 1
#define BOT_PWM_DOOR_BACK_BOTTOM 3
#define BOT_PWM_DOOR_BACK_TOP 4

#define BOT_PWM_CLAMP_OPEN_TIME 225
#define BOT_PWM_CLAMP_OPEN 0x3ff, 225, 0
#define BOT_PWM_CLAMP_CLOSE_TIME 225
#define BOT_PWM_CLAMP_CLOSE -0x3ff, 225, 0

#define BOT_PWM_DOOR_OPEN_TIME 225
#define BOT_PWM_DOOR_OPEN 0x3ff, 225, 0
#define BOT_PWM_DOOR_CLOSE_TIME 225
#define BOT_PWM_DOOR_CLOSE -0x3ff, 225, 0

#endif /* bot_h */