Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Dependencies: mbed
main.cpp
- Committer:
- haarkon2
- Date:
- 2020-05-22
- Revision:
- 0:4b4597f9e0df
File content as of revision 0:4b4597f9e0df:
#include "mbed.h"
#include <stdio.h>
//les 4 premiers bits de la variable trame sont pour la couleur
#define bleu 0x1000
#define rouge 0x2000
#define violet 0x4000 //bleu et rouge
#define rose 0x8000
//les 4 suivants pour le nombre de capteurs recus
//les 12 suivants toutes les positions des robots
#define nord 0x0100
#define est 0x0200
#define ouest 0x0400
#define sud 0x0800
//les directions des robots advers
#define face 0x0010
#define droite 0x0020
#define gauche 0x0040
#define derriere 0x0080
Serial pc(SERIAL_TX, SERIAL_RX, 115200);
DigitalIn IT(PA_3);
Ticker ticker;
DigitalOut tick(PA_8);
SPI spi(PA_7, PA_6, PA_5); //mosi, miso, sclk
DigitalOut cs(PA_4); //lance le compteur du SPI sur le FPGA
//cette fonction permet de generer un tick au FPGA pour changer le numero du capteur et aussi cadencé appel_spi()
void flip();
//permet de parler en SPI avec le FPGA
int appel_spi();
//calculer le nombre de capteur + le type du robot
void mini_traitement(unsigned int tableau[]);
//pour le SPI
int trame_spi = 0, pause_entre_trame = 0, ctp_ticker = 0, incrementation_for = 0;
//pour le traitement
int trame = 0, trame_robot1 = 0, trame_robot2 = 0, trame_robot3 = 0, urgence = 0;
int main()
{
cs = 1;
spi.format(16,0);
spi.frequency(1000000); //1MHz soit 1µs de periode par bits dans la trame si
ticker.attach(&flip, 0.0005); //soit 1ms entre chaque trame
unsigned int tableau[20] = {0};
while(1) {
//partie SPI
if(IT == 1) {
for(incrementation_for = 0; incrementation_for < 17; incrementation_for++) {
//je lis tout les capteurs soit 16 fois, +1 fois (cours de S3) car le premier appel en SPI n'est pas correct
appel_spi();
tableau[incrementation_for] = trame_spi;
//normalement si on printf l'ordre des trames est 0/8/4/C/2/A/6/E/1/9/5/D/3/B/7/F soit les numeros des capteurs
//pc.printf("%X\n\n\r",trame_spi);
}
//on fait une pause de 18 tick avant de redemander les 16 trames
if(incrementation_for == 17) pause_entre_trame = 1;
mini_traitement(tableau);
trame = 0;
}
}
}
void flip()
{
if(pause_entre_trame == 0) tick = !tick;
if(pause_entre_trame == 1) {
ctp_ticker++;
if(ctp_ticker == 18) {
pause_entre_trame = 0;
ctp_ticker = 0;
}
}
}
int appel_spi()
{
if(incrementation_for == 16) {
cs = 0;
trame_spi = spi.write(0x5555);
cs = 1;
} else {
while(tick == 1);
cs = 0;
trame_spi = spi.write(0x5555);
wait_ms(0.05);
cs = 1;
while(tick == 0);
}
return trame_spi;
}
void mini_traitement(unsigned int tableau[])
{
char a = 0, b = 0, c = 0, d = 0, e = 0, f = 0, g = 0, h = 0, j = 0, k = 0, l = 0, m = 0;
int traitement_type = 0;
int nb_robot = 0, nb_capteur = 0, type_robot = 0, type_robot_1 = 0, type_robot_2 = 0, type_robot_3 = 0, cote = 0, cote_robot_1 = 0, cote_robot_2 = 0, cote_robot_3 = 0;
unsigned char tab[4][20];
for(char i = 0; i < 4; i++) {
for(char n = 0; n < 20; n++) tab[i][n] = 0;
}
int cote_robot[4];
for(char i = 0; i < 4; i++) cote_robot[i] = 0;
for(char i = 1; i < 17; i++) {
if((tableau[i] & 0xFFF0) != 0) {
nb_capteur ++;
traitement_type = (tableau[i] & 0x1800);
if(i == 5 || i == 6 || (i >= 8 && i <= 12)) {
if (traitement_type == 0x1000) {b++;tab[2][i] = 1;
} else if(traitement_type == 0x0800) {a++;tab[1][i] = 1;
} else if(traitement_type == 0x1800 || traitement_type == 0x0000) {c++;tab[3][i] = 1;}
} else {
if (traitement_type == 0x1000) {a++;tab[1][i] = 1;
} else if(traitement_type == 0x0800) {b++;tab[2][i] = 1;
} else if(traitement_type == 0x1800 || traitement_type == 0x0000) {c++;tab[3][i] = 1;}
}
}
}
//nombre de robot + type de robot + nb capteur
//methode 2 de spi_traitement_v1
if(a >= 1) { nb_robot++; type_robot = bleu; type_robot_1 = bleu; }
if(b >= 1) { if(nb_robot == 1) type_robot = violet; else type_robot = rouge; nb_robot++; type_robot_2 = rouge; }
if(c >= 1) { if(nb_robot == 2) type_robot = type_robot | rose; else if(nb_robot == 1) type_robot = type_robot | rose; else type_robot = rose; nb_robot++; type_robot_3 = rose; }
trame_robot1 = type_robot_1 | a;
trame_robot2 = type_robot_2 | b;
trame_robot3 = type_robot_3 | c;
d = a + b + c;
trame = type_robot | (d << 4) | nb_robot;
//cote par rapport a notre robot
for(char i = 1; i < 4; i++) {
if((tab[i][16] == 1 || tab[i][15] == 1 || tab[i][1] == 1) && e == 0) {
e = 1;
cote = est;
if(tab[i][3] == 1) cote = cote | nord;
if(tab[i][13] == 1) cote = cote | sud;
} else if((tab[i][4] == 1 || tab[i][3] == 1 || tab[i][5] == 1) && f == 0) {
f = 1;
cote = nord;
if(tab[i][1] == 1) cote = cote | est;
if(tab[i][7] == 1) cote = cote | ouest;
} else if((tab[i][8] == 1 || tab[i][7] == 1 || tab[i][9] == 1) && g == 0) {
g = 1;
cote = ouest;
if(tab[i][5] == 1) cote = cote | nord;
if(tab[i][11] == 1) cote = cote | sud;
} else if((tab[i][12] == 1 || tab[i][11] == 1 || tab[i][13] == 1) && h == 0) {
h = 1;
cote = sud;
if(tab[i][9] == 1) cote = cote | ouest;
if(tab[i][15] == 1) cote = cote | est;
} else {
if(tab[i][2] == 1 && j == 0) {
j = 1;
cote = est | nord;
} else if(tab[i][6] == 1 && k == 0) {
k = 1;
cote = nord | ouest;
} else if(tab[i][10] == 1 && l == 0) {
l = 1;
cote = ouest | sud;
} else if(tab[i][14] == 1 && m == 0) {
m = 1;
cote = sud | est;
}
}
if(i == 1) cote_robot_1 = cote;
if(i == 2) cote_robot_2 = cote;
if(i == 3) cote_robot_3 = cote;
cote = 0;
//cote robot advers
for(char o = 1; o < 17; o++) {
if(tab[i][o] == 1) {
cote_robot[i] = (tableau[i] & 0x0700);
if (cote_robot[i] == 0x0000) cote_robot[i] = face; //pc.printf("face\n\n\r"); }
else if(cote_robot[i] == 0x0100) cote_robot[i] = derriere; //pc.printf("derriere\n\n\r"); }
else if(cote_robot[i] == 0x0200) cote_robot[i] = droite; //pc.printf("droite\n\n\r"); }
else if(cote_robot[i] == 0x0300) cote_robot[i] = gauche; //pc.printf("gauche\n\n\r"); }
else if(cote_robot[i] == 0x0400) cote_robot[i] = face | droite; //pc.printf("face droite\n\n\r"); }
else if(cote_robot[i] == 0x0500) cote_robot[i] = face | gauche; //pc.printf("face gauche\n\n\r"); }
else if(cote_robot[i] == 0x0600) cote_robot[i] = derriere | droite; //pc.printf("derriere droite\n\n\r"); }
else cote_robot[i] = derriere | gauche; //pc.printf("derriere gauche\n\n\r"); }
}
}
}
trame_robot1 = trame_robot1 | cote_robot_1 | cote_robot[1];
trame_robot2 = trame_robot2 | cote_robot_2 | cote_robot[2];
trame_robot3 = trame_robot3 | cote_robot_3 | cote_robot[3];
trame = trame | cote_robot_1 | cote_robot_2 | cote_robot_3;
pc.printf("%X ; %X ; %X ; %X\n\n\r", trame, trame_robot1, trame_robot2, trame_robot3);
}