Skip to content

Commit 319e8b1

Browse files
committed
Update and Add New Examples
Update and Add New Examples
1 parent b1f2c9a commit 319e8b1

File tree

13 files changed

+341
-258
lines changed

13 files changed

+341
-258
lines changed
Original file line numberDiff line numberDiff line change
@@ -1,113 +1,113 @@
11
/********************************************** CHARIOT ******************************************/
22
/* 2xMotionBlock, 1xCubeBlock, 1xMainBlock, 1xDetectBlock, 1xLightBlock, 1xBippBlock */
33

4-
#include "SmartBlockFunctions.h"
4+
#include "cezerioBlocks.h"
55
#include "DataTransferFunctions.h"
66

77
unsigned char timerFlag = 0;
88
extern unsigned char resolvePacketFlag;
99
extern capturedPacketType capturedPacket;
1010

1111
void setup()
12-
{
13-
initSmartBlocks();
12+
{
13+
initcezerioBlocks();
1414
initSmartBlue();
1515
}
1616

1717
void loop()
1818
{
19-
#if defined(CAN_RECEIVE_INTERRUPT_ENABLE)
19+
#if defined(CAN_RECEIVE_INTERRUPT_ENABLE)
2020
if(!digitalRead(CAN_INT))
2121
{
22-
22+
2323
}
2424
#endif
2525

2626
if(timerFlag)
2727
{
28-
28+
2929
timerFlag = 0;
3030
}
3131

32-
getSmartBlueData();
32+
getSmartBlueData();
3333

3434
if(resolvePacketFlag)
3535
{
3636
switch(capturedPacket.data_packet.packet_id)
37-
{
37+
{
3838
case BLE_ROBOT_NAME: // gelen robot id "0x00" ve data değeri "0xFF" ise robot id'sini gönderir
3939
if(capturedPacket.data_packet.robot_id == 0x00 && capturedPacket.data_packet.data[0] == 0xFF)
4040
{
4141
sendChariotData(BLE_ROBOT_NAME, 0xFF);
4242
}
43-
break;
44-
43+
break;
44+
4545
case BLE_MOVE_FORWARD:
4646
setMotion(0x140, motorDirectionForward, capturedPacket.data_packet.data[0], motorDriverEnable); /*Front_Left Wheel*/
4747
setMotion(0x141, motorDirectionForward, capturedPacket.data_packet.data[0], motorDriverEnable); /*Front_Right Wheel*/
4848
break;
49-
49+
5050
case BLE_MOVE_BACKWARD:
5151
setMotion(0x140, motorDirectionBackward, capturedPacket.data_packet.data[0], motorDriverEnable); /*Front_Left Wheel*/
5252
setMotion(0x141, motorDirectionBackward, capturedPacket.data_packet.data[0], motorDriverEnable); /*Front_Right Wheel*/
5353
break;
54-
54+
5555
case BLE_MOVE_RIGHT:
5656
setMotion(0x140,motorDirectionForward,capturedPacket.data_packet.data[0],motorDriverEnable); /*Front_Left Wheel*/
5757
setMotion(0x141,motorDirectionForward,(capturedPacket.data_packet.data[0])/2,motorDriverEnable); /*Front_Right Wheel*/
5858
break;
59-
59+
6060
case BLE_MOVE_LEFT:
6161
setMotion(0x140,motorDirectionForward,(capturedPacket.data_packet.data[0])/2,motorDriverEnable); /*Front_Left Wheel*/
6262
setMotion(0x141,motorDirectionForward,capturedPacket.data_packet.data[0],motorDriverEnable); /*Front_Right Wheel*/
6363
break;
64-
64+
6565
case BLE_MOVE_FORWARD_RIGHT:
6666
setMotion(0x140,motorDirectionForward,capturedPacket.data_packet.data[0],motorDriverEnable); /*Front_Left Wheel*/
6767
setMotion(0x141,motorDirectionForward,(capturedPacket.data_packet.data[0])*0.75,motorDriverEnable); /*Front_Right Wheel*/
6868
break;
69-
69+
7070
case BLE_MOVE_FORWARD_LEFT:
7171
setMotion(0x140,motorDirectionForward,(capturedPacket.data_packet.data[0])*0.75,motorDriverEnable); /*Front_Left Wheel*/
7272
setMotion(0x141,motorDirectionForward,capturedPacket.data_packet.data[0],motorDriverEnable); /*Front_Right Wheel*/
7373
break;
74-
74+
7575
case BLE_MOVE_BACKWARD_RIGHT:
7676
setMotion(0x140, motorDirectionBackward, capturedPacket.data_packet.data[0], motorDriverEnable); /*Front_Left Wheel*/
7777
setMotion(0x141, motorDirectionBackward, (capturedPacket.data_packet.data[0])*0.75, motorDriverEnable); /*Front_Right Wheel*/
7878
break;
79-
79+
8080
case BLE_MOVE_BACKWARD_LEFT:
8181
setMotion(0x140, motorDirectionBackward, (capturedPacket.data_packet.data[0])*0.75, motorDriverEnable); /*Front_Left Wheel*/
8282
setMotion(0x141, motorDirectionBackward, capturedPacket.data_packet.data[0], motorDriverEnable); /*Front_Right Wheel*/
8383
break;
84-
85-
case BLE STOP:
84+
85+
case BLE_STOP:
8686
setMotion(0x140, motorDirectionForward, 0, motorDriverEnable); /*Front_Left Wheel*/
8787
setMotion(0x141, motorDirectionForward, 0, motorDriverEnable); /*Front_Right Wheel*/
8888
break;
89-
89+
9090
case BLE_TURN_360CW:
9191
setMotion(0x140, motorDirectionForward, 255, motorDriverEnable); /*Front_Left Wheel*/
9292
setMotion(0x141, motorDirectionBackward, 255, motorDriverEnable); /*Front_Right Wheel*/
9393
break;
94-
94+
9595
case BLE_TURN_360CCW:
9696
setMotion(0x140, motorDirectionBackward, 255, motorDriverEnable); /*Front_Left Wheel*/
9797
setMotion(0x141, motorDirectionForward, 255, motorDriverEnable); /*Front_Right Wheel*/
9898
break;
99-
99+
100100
case BLE_DETECT_DATA:
101101
sendChariotData(BLE_DETECT_DATA, getDetect(0x020));
102102
break;
103-
103+
104104
case BLE_BIPP:
105105
setBipp(0x0E0,capturedPacket.data_packet.data[0]);
106106
break;
107-
107+
108108
case BLE_LIGHT:
109109
setLight(0x120,capturedPacket.data_packet.data[0]);
110110
break;
111-
111+
}
112112
}
113113
}
Original file line numberDiff line numberDiff line change
@@ -1,118 +1,118 @@
11
/********************************************** FLYING_CAR ******************************************/
22
/* 3xMotionBlock, 3xCubeBlock, 1xMainBlock, 1xDetectBlock, 1xLightBlock, 1xBippBlock */
33

4-
#include "SmartBlockFunctions.h"
4+
#include "cezerioBlocks.h"
55
#include "DataTransferFunctions.h"
66

77
unsigned char timerFlag = 0;
88
extern unsigned char resolvePacketFlag;
99
extern capturedPacketType capturedPacket;
1010

1111
void setup()
12-
{
13-
initSmartBlocks();
12+
{
13+
initcezerioBlocks();
1414
initSmartBlue();
1515
}
1616

1717
void loop()
1818
{
19-
#if defined(CAN_RECEIVE_INTERRUPT_ENABLE)
19+
#if defined(CAN_RECEIVE_INTERRUPT_ENABLE)
2020
if(!digitalRead(CAN_INT))
2121
{
22-
22+
2323
}
2424
#endif
2525

2626
if(timerFlag)
2727
{
28-
28+
2929
timerFlag = 0;
3030
}
3131

32-
getSmartBlueData();
32+
getSmartBlueData();
3333

3434
if(resolvePacketFlag)
3535
{
3636
switch(capturedPacket.data_packet.packet_id)
37-
{
37+
{
3838
case BLE_ROBOT_NAME: // gelen robot id "0x00" ve data değeri "0xFF" ise robot id'sini gönderir
3939
if(capturedPacket.data_packet.robot_id == 0x00 && capturedPacket.data_packet.data[0] == 0xFF)
4040
{
4141
sendFlyingCarData(BLE_ROBOT_NAME, 0xFF);
4242
}
43-
break;
44-
43+
break;
44+
4545
case BLE_MOVE_FORWARD:
4646
setMotion(0x140, motorDirectionForward, capturedPacket.data_packet.data[0], motorDriverEnable); /*Front_Left Wheel*/
4747
setMotion(0x141, motorDirectionForward, capturedPacket.data_packet.data[0], motorDriverEnable); /*Front_Right Wheel*/
4848
break;
49-
49+
5050
case BLE_MOVE_BACKWARD:
5151
setMotion(0x140, motorDirectionBackward, capturedPacket.data_packet.data[0], motorDriverEnable); /*Front_Left Wheel*/
5252
setMotion(0x141, motorDirectionBackward, capturedPacket.data_packet.data[0], motorDriverEnable); /*Front_Right Wheel*/
5353
break;
54-
54+
5555
case BLE_MOVE_RIGHT:
5656
setMotion(0x140,motorDirectionForward,capturedPacket.data_packet.data[0],motorDriverEnable); /*Front_Left Wheel*/
5757
setMotion(0x141,motorDirectionForward,(capturedPacket.data_packet.data[0])/2,motorDriverEnable); /*Front_Right Wheel*/
5858
break;
59-
59+
6060
case BLE_MOVE_LEFT:
6161
setMotion(0x140,motorDirectionForward,(capturedPacket.data_packet.data[0])/2,motorDriverEnable); /*Front_Left Wheel*/
6262
setMotion(0x141,motorDirectionForward,capturedPacket.data_packet.data[0],motorDriverEnable); /*Front_Right Wheel*/
6363
break;
64-
64+
6565
case BLE_MOVE_FORWARD_RIGHT:
6666
setMotion(0x140,motorDirectionForward,capturedPacket.data_packet.data[0],motorDriverEnable); /*Front_Left Wheel*/
6767
setMotion(0x141,motorDirectionForward,(capturedPacket.data_packet.data[0])*0.75,motorDriverEnable); /*Front_Right Wheel*/
6868
break;
69-
69+
7070
case BLE_MOVE_FORWARD_LEFT:
7171
setMotion(0x140,motorDirectionForward,(capturedPacket.data_packet.data[0])*0.75,motorDriverEnable); /*Front_Left Wheel*/
7272
setMotion(0x141,motorDirectionForward,capturedPacket.data_packet.data[0],motorDriverEnable); /*Front_Right Wheel*/
7373
break;
74-
74+
7575
case BLE_MOVE_BACKWARD_RIGHT:
7676
setMotion(0x140, motorDirectionBackward, capturedPacket.data_packet.data[0], motorDriverEnable); /*Front_Left Wheel*/
7777
setMotion(0x141, motorDirectionBackward, (capturedPacket.data_packet.data[0])*0.75, motorDriverEnable); /*Front_Right Wheel*/
7878
break;
79-
79+
8080
case BLE_MOVE_BACKWARD_LEFT:
8181
setMotion(0x140, motorDirectionBackward, (capturedPacket.data_packet.data[0])*0.75, motorDriverEnable); /*Front_Left Wheel*/
8282
setMotion(0x141, motorDirectionBackward, capturedPacket.data_packet.data[0], motorDriverEnable); /*Front_Right Wheel*/
8383
break;
84-
85-
case BLE STOP:
84+
85+
case BLE_STOP:
8686
setMotion(0x140, motorDirectionForward, 0, motorDriverEnable); /*Front_Left Wheel*/
8787
setMotion(0x141, motorDirectionForward, 0, motorDriverEnable); /*Front_Right Wheel*/
8888
break;
89-
89+
9090
case BLE_TURN_360CW:
9191
setMotion(0x140, motorDirectionForward, 255, motorDriverEnable); /*Front_Left Wheel*/
9292
setMotion(0x141, motorDirectionBackward, 255, motorDriverEnable); /*Front_Right Wheel*/
9393
break;
94-
94+
9595
case BLE_TURN_360CCW:
9696
setMotion(0x140, motorDirectionBackward, 255, motorDriverEnable); /*Front_Left Wheel*/
9797
setMotion(0x141, motorDirectionForward, 255, motorDriverEnable); /*Front_Right Wheel*/
9898
break;
99-
99+
100100
case BLE_FLIP:
101101
setMotion(0x142, motorDirectionForward, capturedPacket.data_packet.data[0], motorDriverEnable); /*Propeller*/
102102

103103
break;
104-
104+
105105
case BLE_DETECT_DATA:
106106
sendFlyingCarData(BLE_DETECT_DATA, getDetect(0x020));
107107
break;
108-
108+
109109
case BLE_BIPP:
110110
setBipp(0x0E0,capturedPacket.data_packet.data[0]);
111111
break;
112-
112+
113113
case BLE_LIGHT:
114114
setLight(0x120,capturedPacket.data_packet.data[0]);
115115
break;
116-
116+
}
117117
}
118118
}

0 commit comments

Comments
 (0)