500SL Send code
This commit is contained in:
parent
fc74aac1c9
commit
67226aaddc
@ -1,7 +1,23 @@
|
||||
void Generate_Code()
|
||||
|
||||
//Generate line1 and line 2 with 14 chars
|
||||
void Generate_Code14()
|
||||
{
|
||||
//scroll chars
|
||||
|
||||
|
||||
byte tmp_byte;
|
||||
|
||||
//scroll chars line 1
|
||||
tmp_byte = line1_14[13];
|
||||
for (int i = 12; i >= 0; i--)
|
||||
{
|
||||
line1_14[i + 1] = line1_14[i];
|
||||
}
|
||||
line1_14[0] = tmp_byte;
|
||||
|
||||
|
||||
//scroll chars line 2
|
||||
tmp_byte = line2_14[0];
|
||||
for (int i = 1; i <= 13; i++)
|
||||
{
|
||||
line2_14[i - 1] = line2_14[i];
|
||||
}
|
||||
line2_14[13] = tmp_byte;
|
||||
}
|
||||
|
||||
@ -33,6 +33,9 @@ bool watchdog_send = false; //500SL Wachtdog send, thus switched to ve
|
||||
//void Linx500SL_Watchdog();
|
||||
//void Linx500SL_SendCode();
|
||||
|
||||
char line1_14[] = {'1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '1', '2', '3', '4'};
|
||||
char line2_14[] = {'A', 'B', 'C', 'D', 'E', 'F', 'G', 'H', 'I', 'J', 'K', 'L', 'M', 'N'};
|
||||
|
||||
void setup() {
|
||||
|
||||
|
||||
@ -75,8 +78,12 @@ void setup() {
|
||||
display.display();
|
||||
display.clearDisplay();
|
||||
display.setCursor(10, 0);
|
||||
if(lasertype==1) {display.println(F("Linx 500SL"));}
|
||||
if(lasertype==2) {display.println(F("MundiScan 2000"));}
|
||||
if (lasertype == 1) {
|
||||
display.println(F("Linx 500SL"));
|
||||
}
|
||||
if (lasertype == 2) {
|
||||
display.println(F("MundiScan 2000"));
|
||||
}
|
||||
display.setCursor(0, 10);
|
||||
display.println(F("Sniffer mode selected"));
|
||||
display.display();
|
||||
@ -98,8 +105,12 @@ void loop() {
|
||||
display.setTextSize(1);
|
||||
display.setTextColor(SSD1306_WHITE);
|
||||
display.setCursor(10, 0);
|
||||
if(lasertype==1) {display.println(F("Linx 500SL"));}
|
||||
if(lasertype==2) {display.println(F("MundiScan 2000"));}
|
||||
if (lasertype == 1) {
|
||||
display.println(F("Linx 500SL"));
|
||||
}
|
||||
if (lasertype == 2) {
|
||||
display.println(F("MundiScan 2000"));
|
||||
}
|
||||
display.setCursor(0, 10);
|
||||
display.println(F("Sniffer mode selected"));
|
||||
display.display();
|
||||
@ -112,8 +123,12 @@ void loop() {
|
||||
display.setTextSize(1);
|
||||
display.setTextColor(SSD1306_WHITE);
|
||||
display.setCursor(10, 0);
|
||||
if(lasertype==1) {display.println(F("Linx 500SL"));}
|
||||
if(lasertype==2) {display.println(F("MundiScan 2000"));}
|
||||
if (lasertype == 1) {
|
||||
display.println(F("Linx 500SL"));
|
||||
}
|
||||
if (lasertype == 2) {
|
||||
display.println(F("MundiScan 2000"));
|
||||
}
|
||||
display.setCursor(0, 10);
|
||||
display.println(F("Send mode selected"));
|
||||
display.display();
|
||||
@ -166,16 +181,25 @@ void loop() {
|
||||
Serial.println("Linx 500SL : Sending WatchDog command to switch to VectorService Protocol");
|
||||
|
||||
Linx500SL_Watchdog();
|
||||
if(!watchdog_send) {Serial.println("Linx 500SL : Error !! --> No Response from laser");}
|
||||
if(watchdog_send) {Serial.println("Linx 500SL : Laser switched to VectorService Protocol !!");}
|
||||
if (!watchdog_send) {
|
||||
Serial.println("Linx 500SL : Error !! --> No Response from laser");
|
||||
}
|
||||
if (watchdog_send) {
|
||||
Serial.println("Linx 500SL : Laser switched to VectorService Protocol !!");
|
||||
}
|
||||
|
||||
display.setCursor(0, 20);
|
||||
display.setTextColor(WHITE, BLACK);
|
||||
if(!watchdog_send) {display.println(F("No Response laser !! "));}
|
||||
if(watchdog_send) {display.println(F("Laser Connected !! "));}
|
||||
if (!watchdog_send) {
|
||||
display.println(F("No Response laser !! "));
|
||||
}
|
||||
if (watchdog_send) {
|
||||
display.println(F("Laser Connected !! "));
|
||||
}
|
||||
display.display();
|
||||
delay(5000);
|
||||
|
||||
// ik even geen laser heb ;-)
|
||||
watchdog_send = true;
|
||||
}
|
||||
else
|
||||
{
|
||||
|
||||
@ -3,29 +3,24 @@ byte SL500_SEQ = 00;
|
||||
byte SL500_CRC = 00;
|
||||
byte SL500_XOR = 00;
|
||||
|
||||
|
||||
//char SL500SL_WD[] = {204,170,0,0,0,1,0,0,0,1,0,19,0,0,0,43,0,0,0};
|
||||
char SL500_WD[] = {0xCC,0xAA,0x00,0x00,0x00,0x01,0x00,0x00,0x00,0x01,0x00,0x13,0x00,0x00,0x00,0x2B,0x00,0x00,0x00};
|
||||
|
||||
|
||||
|
||||
//Send Wachtdog and wait for a reply to switch 500SL laser into VectorService Protocol
|
||||
|
||||
//Wachdog command CC AA 00 00 00 01 00 00 00 01 00 13 00 00 00 2B [SEQ] [CRC] [XOR]
|
||||
|
||||
void Linx500SL_Watchdog()
|
||||
{
|
||||
char SL500_WD[] = {0xCC, 0xAA, 0x00, 0x00, 0x00, 0x01, 0x00, 0x00, 0x00, 0x01, 0x00, 0x13, 0x00, 0x00, 0x00, 0x2B, 0x00, 0x00, 0x00};
|
||||
|
||||
int count = 0;
|
||||
byte p2_rec_byte;
|
||||
|
||||
while ((!watchdog_send) && count < 15)
|
||||
while ((!watchdog_send) && count < 5)
|
||||
{
|
||||
|
||||
SL500_SEQ = SL500_SEQ + 1;
|
||||
SL500_SEQ++;
|
||||
SL500_WD[16] = SL500_SEQ;
|
||||
|
||||
Linx500_Checksum(16);
|
||||
Linx500_Checksum(SL500_WD, 16);
|
||||
|
||||
SL500_WD[17] = SL500_CRC;
|
||||
SL500_WD[18] = SL500_XOR;
|
||||
@ -61,33 +56,90 @@ void Linx500SL_Watchdog()
|
||||
//500SL Send Code
|
||||
void Linx500SL_SendCode()
|
||||
{
|
||||
Generate_Code();
|
||||
|
||||
char line1[60] = {0xCC, 0xAA, 0x00, 0x00, 0x00, 0x01, 0x00, 0x00, 0x00, 0x01, 0x00, 0x37, 0x00, 0x00, 0x00, 0x25, 0xFF, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x000, 0x00};
|
||||
char line2[60] = {0xCC, 0xAA, 0x00, 0x00, 0x00, 0x01, 0x00, 0x00, 0x00, 0x01, 0x00, 0x37, 0x00, 0x00, 0x00, 0x25, 0xFF, 0x00, 0x00, 0x00, 0x01, 0x00, 0x00, 0x000, 0x00};
|
||||
|
||||
//pos 20 = Remote update Field
|
||||
//pos 16 = SEQ
|
||||
//pos 25 = Start tekst
|
||||
#define pos_seq 16
|
||||
#define pos_txt 25
|
||||
|
||||
Generate_Code14();
|
||||
|
||||
//Line 1
|
||||
SL500_SEQ++;
|
||||
line1[pos_seq] = SL500_SEQ;
|
||||
Serial.println("");
|
||||
Serial.print("Linx500SL --> Line 1 : ");
|
||||
for (int i = 0; i <= 13; i++)
|
||||
{
|
||||
line1[pos_txt + (i * 2)] = line1_14[i];
|
||||
line1[pos_txt + (i * 2) + 1] = 0;
|
||||
Serial.write(line1_14[i]);
|
||||
}
|
||||
|
||||
Linx500_Checksum(line1, pos_txt + 28);
|
||||
|
||||
line1[pos_txt + 28] = SL500_CRC;
|
||||
line1[pos_txt + 28 + 1] = SL500_XOR;
|
||||
|
||||
//Write all chars to Serial port
|
||||
for (int i = 0; i <= (pos_txt + 28 + 1); i++)
|
||||
{
|
||||
MySerial1.write(line1[i]);
|
||||
}
|
||||
Serial.println("");
|
||||
|
||||
//Line 2
|
||||
SL500_SEQ++;
|
||||
line2[pos_seq] = SL500_SEQ;
|
||||
Serial.println("");
|
||||
Serial.print("Linx500SL --> Line 2 : ");
|
||||
for (int i = 0; i <= 13; i++)
|
||||
{
|
||||
line2[pos_txt + (i * 2)] = line2_14[i];
|
||||
line2[pos_txt + (i * 2) + 1] = 0;
|
||||
Serial.write(line1_14[i]);
|
||||
}
|
||||
|
||||
Linx500_Checksum(line2, pos_txt + 28);
|
||||
|
||||
line2[pos_txt + 28] = SL500_CRC;
|
||||
line2[pos_txt + 28 + 1] = SL500_XOR;
|
||||
|
||||
//Write all chars to Serial port
|
||||
for (int i = 0; i <= (pos_txt + 28 + 1); i++)
|
||||
{
|
||||
MySerial1.write(line2[i]);
|
||||
}
|
||||
Serial.println("");
|
||||
|
||||
}
|
||||
|
||||
|
||||
|
||||
void Linx500_Checksum(int char_count)
|
||||
//Linx 500 SL Calculate CRC and XOR
|
||||
void Linx500_Checksum(char *cmd_line, int char_count)
|
||||
{
|
||||
|
||||
long val_crc = 0;
|
||||
long val_xor = 0;
|
||||
|
||||
//Checksum Calculation
|
||||
for (int i = 0; i <= char_count; i++)
|
||||
{
|
||||
val_crc = val_crc + SL500_WD[i];
|
||||
val_xor = val_xor ^ SL500_WD[i];
|
||||
val_crc = val_crc + cmd_line[i];
|
||||
val_xor = val_xor ^ cmd_line[i];
|
||||
}
|
||||
|
||||
val_crc = 255 - (val_crc % 256);
|
||||
|
||||
Serial.print("Checksum : ");
|
||||
Serial.println(val_crc);
|
||||
Serial.println(val_xor);
|
||||
Serial.println("");
|
||||
Serial.print("Checksum : CRC = ");
|
||||
Serial.print(val_crc, HEX);
|
||||
Serial.print (" XOR = ");
|
||||
Serial.print(val_xor, HEX);
|
||||
Serial.println("");
|
||||
|
||||
SL500_CRC = val_crc;
|
||||
SL500_XOR = val_xor;
|
||||
|
||||
Loading…
x
Reference in New Issue
Block a user