Révision 153
Ajouté par anfichot1 il y a plus de 6 ans
branch/fichot/Emb_App/SessionM32C_E8a_system.ini | ||
---|---|---|
[Target]
|
||
M32C E8a SYSTEM=Renesas Communications
|
||
[USER_DATA]
|
||
RESET=ff0016
|
||
RESET=ff0020
|
branch/fichot/Emb_App/programme_principal_etud.c | ||
---|---|---|
// disponible. 0xab avec a-> nombre de couleurs bien plac?es et b -> couleurs pr?sentes mais mal plac?es.
|
||
//'I'/73/Ox49 : D?finition du nom du v?hicule. Doit d?buter par le caract?re '#' et entraine le chargement de la configuration de piste
|
||
// correspondant au nom du v?hicule si le nom se termine par '*'
|
||
|
||
|
||
|
||
void vit_rot()
|
||
{
|
||
CanFrame comm;
|
||
comm.data.id = 'T';
|
||
comm.data.rtr = 0;
|
||
comm.data.val = 120;
|
||
snd_dtq(CanTx, comm.msg);
|
||
}
|
||
int cons=450;
|
||
int retour=0;
|
||
int k=5;
|
||
int valeur=20;
|
||
int vitesse=80;
|
||
|
||
|
||
void angle()
|
||
{
|
||
CanFrame req;
|
||
CanFrame reponse;
|
||
float alpha;
|
||
req.data.id = 'R';
|
||
req.data.rtr = 1;
|
||
snd_dtq (CanTx,req.msg);
|
||
CanFrame vit_roue;
|
||
|
||
rcv_dtq(CanRx, &reponse.msg);
|
||
alpha = reponse.data.val;
|
||
|
||
|
||
void ComMoteur(){
|
||
vit_roue.data.id='V';
|
||
vit_roue.data.rtr=0;
|
||
vit_roue.data.val=vitesse;
|
||
snd_dtq (CanTx,vit_roue.msg);
|
||
}
|
||
|
||
void asserv()
|
||
{
|
||
CanFrame comm;
|
||
CanFrame req;
|
||
CanFrame reponse;
|
||
while(1){
|
||
|
||
req.data.id='R';
|
||
req.data.rtr=1;
|
||
|
||
snd_dtq (CanTx,req.msg);
|
||
retour=periph[ADDR('R')].val;
|
||
|
||
comm.data.id='T';
|
||
comm.data.rtr=0;
|
||
comm.data.val=valeur;
|
||
snd_dtq (CanTx,comm.msg);
|
||
if(retour!=cons) valeur=k*(cons-retour);
|
||
|
||
}
|
||
}
|
||
|
||
|
||
|
||
|
||
|
||
|
||
|
||
void main()
|
||
{
|
||
ports_mcu();
|
||
... | ... | |
dly_tsk(100);
|
||
LED_J=0;
|
||
dly_tsk(100);
|
||
|
||
asserv();
|
||
ComMoteur();
|
||
}
|
||
|
||
}
|
||
|
||
void acqui()
|
Formats disponibles : Unified diff
ajout de la fonction pour démarrer moteur,