Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <SoftwareSerial.h>
- SoftwareSerial RS485(10, 11);
- int rychlost = 0;
- byte prevodniTabulka[] = {
- 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09,
- 0x10, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16, 0x17, 0x18, 0x19,
- 0x20, 0x21, 0x22, 0x23, 0x24, 0x25, 0x26, 0x27, 0x28, 0x29,
- 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39,
- 0x40, 0x41, 0x42, 0x43, 0x44, 0x45, 0x46, 0x47, 0x48, 0x49,
- 0x50, 0x51, 0x52, 0x53, 0x54, 0x55, 0x56, 0x57, 0x58, 0x59,
- 0x60, 0x61, 0x62, 0x63, 0x64, 0x65, 0x66, 0x67, 0x68, 0x69,
- 0x70, 0x71, 0x72, 0x73, 0x74, 0x75, 0x76, 0x77, 0x78, 0x79,
- 0x80, 0x81, 0x82, 0x83, 0x84, 0x85, 0x86, 0x87, 0x88, 0x89,
- 0x90, 0x91, 0x92, 0x93, 0x94, 0x95, 0x96, 0x97, 0x98, 0x99
- }
- void setup() {
- Serial.begin(115200);
- Serial.setTimeout(2);
- RS485.begin(9600);
- }
- void loop() {
- if(Serial.available() > 0){
- rychlost = Serial.parseInt();
- }
- byte rychlostHEX = rychlost;
- byte hodinyHEX = prevodniTabulka[fmod(floor(millis()/1000),60)];
- byte minutyHEX = prevodniTabulka[fmod(floor(millis()/60000),60)];
- byte sekundyHEX = prevodniTabulka[fmod(floor(millis()/360000),24)];
- digitalWrite(3, 1);
- byte msg[27];
- msg[0] = 0x19; //počet bajtů ve zprávě
- msg[1] = 0x01; //kód povelu 01
- msg[2] = 0x00; // Stavové slovo zprávy
- msg[3] = sekundyHEX; //Vteřiny
- msg[4] = minutyHEX; //minuty
- msg[5] = hodinyHEX; // Hodiny
- msg[6] = 0x28; //den
- msg[7] = 0x11; //Měsíc
- msg[8] = 0x18; //Rok
- msg[9] = 0x88; //dráha
- msg[10] = 0x03; //pokračování dráhy
- msg[11] = 0x03; //pokračování dráhy
- msg[12] = 0x02; //pokračování dráhy
- msg[13] = rychlostHEX; //Rychlost aktuální
- msg[14] = 0x00; //Rychlost navolená
- msg[15] = 0x8C; //Rychlost maximální
- msg[16] = 0x00; //Tlak v HP
- msg[17] = 0x00; //další analogová veličina (dostupné z menu)
- msg[18] = 0x00; //1. digitální veličina (dostupné z menu)
- msg[19] = 0x00; //2. digitální veličina (dostupné z menu)
- msg[20] = 0x00; //3. digitální veličina (dostupné z menu)
- msg[21] = 0x00; //4. digitální veličina (dostupné z menu)
- msg[22] = 0x00; //5. digitální veličina (dostupné z menu)
- msg[23] = 0x00; //Chybový bajt
- msg[24] = 0x00; //Traťová značka - netuším co to jako má být
- msg[25] = 0x00; //Traťová značka - netuším co to jako má být
- //Kontrolní součet
- uint8_t CRC = 0;
- for(int8_t i = 0; i< 25; i++){
- CRC -= msg[i];
- }
- msg[26] = CRC;
- RS485.write(msg,27);
- digitalWrite(3, 0);
- delay(100);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement