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.
headre.cpp
- Committer:
- Ciesarik3
- Date:
- 2018-01-04
- Revision:
- 5:c1952cbf8111
File content as of revision 5:c1952cbf8111:
/*#include "mbed.h"
#include "headre.h"
#include "definicie.h"
char crc=0x00;
//Serial pc(USBTX, USBRX, 57600);
int i;
char prijemSpravy[30];
void prijmemSpravu()
{
//pc.attach(&prijmemSpravu);
for (int j=0;j<4;j++)
{
while(true)
{
if(pc.readable()==1)
{
prijemSpravy[j]=pc.getc();
break;
}
}
}
int pom= prijemSpravy[3] + 1;
for (int j=0;j<pom;j++)
{
while(true)
{
if(pc.readable()==1)
{
prijemSpravy[j+4]=pc.getc();
break;
}
}
}
pc.attach(&prijmemSpravu);
}
void poslemSpravu(char adrRX, char adrTX, int velkost, char DATA[] )
{
crc=0x00;
char odosli[5+velkost];
odosli[0]=0xA0;
odosli[1]=adrRX;
odosli[2]=adrTX;
odosli[3]=velkost;
crc=crc8table[crc^adrRX];
crc=crc8table[crc^adrTX];
for (i=0; i<velkost; i++) {
odosli[4+i]=DATA[i];
}
for (i=0; i<velkost; i++) {
crc=crc8table[crc^DATA[i]];
}
odosli[velkost+4]=crc;
for (i=0; i<velkost+5; i++) {
pc.putc(odosli[i]);
}
}
void zamkni()
{
char DATA[]= {0x01};
poslemSpravu(VYTAH,0xcc,sizeof(DATA),DATA);
}
void odomkni()
{
char DATA[]= {0x00};
poslemSpravu(VYTAH,0xcc,sizeof(DATA),DATA);
}
void stop()
{
char DATA[]= {0x01};
poslemSpravu(MOTOR,0xcc,sizeof(DATA),DATA);
}
void hore()
{
char DATA[]= {0x02,0x64,0x00,0x00,0x00};
poslemSpravu(MOTOR,0xcc,sizeof(DATA),DATA);
}
void dole()
{
char DATA[]= {0x02,0x9c,0xff,0xff,0xff};
poslemSpravu(MOTOR,0xcc,sizeof(DATA),DATA);
}*/
