1
1
/*
2
- This file is part of the Arduino Alvik library.
2
+ This file is part of the Arduino_AlvikCarrier library.
3
3
4
4
Copyright (c) 2023 Arduino SA
5
5
10
10
*/
11
11
12
12
13
- #include " Arduino_Alvik_Firmware .h"
13
+ #include " Arduino_AlvikCarrier .h"
14
14
#include " sensor_line.h"
15
15
#include " sensor_tof_matrix.h"
16
16
#include " ucPack.h"
17
17
18
- Arduino_Alvik_Firmware robot ;
18
+ Arduino_AlvikCarrier alvik ;
19
19
SensorLine line (EXT_A2,EXT_A1,EXT_A0);
20
- SensorTofMatrix tof (robot .wire, EXT_GPIO3, EXT_GPIO2);
20
+ SensorTofMatrix tof (alvik .wire, EXT_GPIO3, EXT_GPIO2);
21
21
22
22
23
23
ucPack packeter (200 );
@@ -44,17 +44,17 @@ float kp, ki, kd;
44
44
45
45
void setup (){
46
46
Serial.begin (115200 );
47
- robot .begin ();
48
- robot .setLedBuiltin (HIGH);
47
+ alvik .begin ();
48
+ alvik .setLedBuiltin (HIGH);
49
49
line.begin ();
50
50
tof.begin ();
51
51
52
52
uint8_t version[3 ];
53
- robot .getVersion (version[0 ], version[1 ], version[2 ]);
53
+ alvik .getVersion (version[0 ], version[1 ], version[2 ]);
54
54
msg_size = packeter.packetC3B (0x7E , version[0 ], version[1 ], version[2 ]);
55
- robot .serial ->write (packeter.msg ,msg_size);
55
+ alvik .serial ->write (packeter.msg ,msg_size);
56
56
57
- robot .setLedBuiltin (LOW);
57
+ alvik .setLedBuiltin (LOW);
58
58
59
59
60
60
code=0 ;
@@ -65,33 +65,33 @@ void setup(){
65
65
}
66
66
67
67
void loop (){
68
- while (robot .serial ->available () > 0 ) {
69
- packeter.buffer .push (robot .serial ->read ());
68
+ while (alvik .serial ->available () > 0 ) {
69
+ packeter.buffer .push (alvik .serial ->read ());
70
70
}
71
71
if (packeter.checkPayload ()) {
72
72
code = packeter.payloadTop ();
73
73
switch (code){
74
74
case ' J' :
75
75
packeter.unpacketC2F (code,left,right);
76
- robot .setRpm (left, right);
76
+ alvik .setRpm (left, right);
77
77
break ;
78
78
/*
79
79
case 'S':
80
- robot .setRpm(0,0);
80
+ alvik .setRpm(0,0);
81
81
break;
82
82
*/
83
83
case ' L' :
84
84
packeter.unpacketC1B (code,leds);
85
- robot .setAllLeds (leds);
85
+ alvik .setAllLeds (leds);
86
86
break ;
87
87
88
88
case ' P' :
89
89
packeter.unpacketC1B3F (code,pid,kp,ki,kd);
90
90
if (pid==' L' ){
91
- robot .setKPidLeft (kp,ki,kd);
91
+ alvik .setKPidLeft (kp,ki,kd);
92
92
}
93
93
if (pid==' R' ){
94
- robot .setKPidRight (kp,ki,kd);
94
+ alvik .setKPidRight (kp,ki,kd);
95
95
}
96
96
break ;
97
97
}
@@ -103,27 +103,27 @@ void loop(){
103
103
case 0 :
104
104
line.update ();
105
105
msg_size = packeter.packetC3I (' l' , line.getLeft (), line.getCenter (), line.getRight ());
106
- robot .serial ->write (packeter.msg ,msg_size);
106
+ alvik .serial ->write (packeter.msg ,msg_size);
107
107
break ;
108
108
case 1 :
109
- robot .updateTouch ();
110
- msg_size = packeter.packetC1B (' t' , robot .getTouchKeys ());
111
- robot .serial ->write (packeter.msg ,msg_size);
109
+ alvik .updateTouch ();
110
+ msg_size = packeter.packetC1B (' t' , alvik .getTouchKeys ());
111
+ alvik .serial ->write (packeter.msg ,msg_size);
112
112
break ;
113
113
case 2 :
114
- robot .updateAPDS ();
115
- msg_size = packeter.packetC3I (' c' , robot .getRed (), robot .getGreen (), robot .getBlue ());
116
- robot .serial ->write (packeter.msg ,msg_size);
114
+ alvik .updateAPDS ();
115
+ msg_size = packeter.packetC3I (' c' , alvik .getRed (), alvik .getGreen (), alvik .getBlue ());
116
+ alvik .serial ->write (packeter.msg ,msg_size);
117
117
break ;
118
118
case 3 :
119
119
if (tof.update_rois ()){
120
120
msg_size = packeter.packetC7I (' f' , tof.getLeft (), tof.getCenterLeft (), tof.getCenter (), tof.getCenterRight (), tof.getRight (), tof.get_min_range_top_mm (), tof.get_max_range_bottom_mm ());
121
- robot .serial ->write (packeter.msg ,msg_size);
121
+ alvik .serial ->write (packeter.msg ,msg_size);
122
122
}
123
123
break ;
124
124
case 4 :
125
- msg_size = packeter.packetC3F (' q' , robot .getRoll (), robot .getPitch (), robot .getYaw ());
126
- robot .serial ->write (packeter.msg ,msg_size);
125
+ msg_size = packeter.packetC3F (' q' , alvik .getRoll (), alvik .getPitch (), alvik .getYaw ());
126
+ alvik .serial ->write (packeter.msg ,msg_size);
127
127
break ;
128
128
}
129
129
sensor_id++;
@@ -134,17 +134,17 @@ void loop(){
134
134
135
135
if (millis ()-tmotor>20 ){
136
136
tmotor=millis ();
137
- robot .updateMotors ();
138
- robot .updateImu ();
139
- msg_size = packeter.packetC2F (' j' , robot .getRpmLeft (),robot .getRpmRight ());
140
- robot .serial ->write (packeter.msg ,msg_size);
137
+ alvik .updateMotors ();
138
+ alvik .updateImu ();
139
+ msg_size = packeter.packetC2F (' j' , alvik .getRpmLeft (),alvik .getRpmRight ());
140
+ alvik .serial ->write (packeter.msg ,msg_size);
141
141
142
142
}
143
143
144
144
if (millis ()-timu>10 ){
145
145
timu=millis ();
146
- robot .updateImu ();
147
- msg_size = packeter.packetC6F (' i' , robot .getAccelerationX (), robot .getAccelerationY (), robot .getAccelerationZ (), robot .getAngularVelocityX (), robot .getAngularVelocityY (), robot .getAngularVelocityZ ());
148
- robot .serial ->write (packeter.msg ,msg_size);
146
+ alvik .updateImu ();
147
+ msg_size = packeter.packetC6F (' i' , alvik .getAccelerationX (), alvik .getAccelerationY (), alvik .getAccelerationZ (), alvik .getAngularVelocityX (), alvik .getAngularVelocityY (), alvik .getAngularVelocityZ ());
148
+ alvik .serial ->write (packeter.msg ,msg_size);
149
149
}
150
150
}
0 commit comments