WebSVN – HomeAutomation – Diff – /branches/modules/PcSoftware/csharp-lib/CanPacket.cs


using System;
using System.Collections.Generic;
using System.Text;
 
public class CanPacket {
    private byte pktclass = 0;
//  private byte type = 0;
//  private byte sid = 0;
//  private byte rid = 0;
    private byte data_length = 0;
    private uint id = 0;
    private byte[] data = new byte[8];
    private byte ext = 1;
    private byte rtr = 0;
   
    public CanPacket() {
       
    }
   
    public CanPacket(byte[] raw,uint startIndex) {
        // 17 bytes, a packet.
        // UART_START_BYTE id[0] id[1] id[2] id[3] extended remote_request data_length d[0] d[1] d[2] d[3] d[4] d[5] d[6] d[7] UART_END_BYTE
        /*
        * 000CCCCx TTTTTTTT SSSSSSSS RRRRRRRR
        *
        * <CLASS> = 00011110 00000000 00000000 00000000 = 0x1E000000    NMT, ...
        * <TYPE>  = 00000000 11111111 00000000 00000000 = 0x00FF0000    NMT[CAN_NMT_PGM_START, CAN_ID_NMT_PGM_ACK, ...]
        * <SID>   = 00000000 00000000 11111111 00000000 = 0x0000FF00    Sender ID
        * <RID>   = 00000000 00000000 00000000 11111111 = 0x000000FF    Receiver ID
        *
        */
       
       
        uint addr = (((uint)raw[startIndex + 3]) << 24) + (((uint)raw[startIndex + 2]) << 16) + (((uint)raw[startIndex + 1]) << 8) + (((uint)raw[startIndex + 0]));
       
        this.id = addr;
        this.pktclass = (byte)((addr & 0x1E000000) >> 25);
//      this.type =  (byte)((addr & 0x00FF0000) >> 16);
//      this.sid =    (byte)((addr & 0x0000FF00) >> 8);
//      this.rid =    (byte)((addr & 0x000000FF));
        this.data_length = raw[startIndex + 6];
       
        ext = (byte)(0x0f & raw[startIndex + 4]);
        rtr = (byte)(0x0f & raw[startIndex + 5]);
       
        for (int i = 0; i < 8; i++) this.data[i] = raw[startIndex + 7 + i];
    }
   
    public CanPacket(string raw) {
        //denna funktion fungerar sådär, se till att bygga en bättre parser
       
        //1e00007f 1 0 04 03 02 01 96 3f 76 15
        string [] split = null;
        split = raw.Split( new Char [] {' '} );
        if ((split.Length >= 3) && (split.Length <= 11)) {
            try {
                id = System.Convert.ToUInt32(split[0].Trim(), 16);
            }
            catch {
                Console.WriteLine("overflow 1");
            }
            try {
                ext = (byte)(System.Convert.ToUInt32(split[1].Trim(), 16)&0xFF);
            }
            catch {
                Console.WriteLine("overflow 2");
            }
            try {
                rtr = (byte)(System.Convert.ToUInt32(split[2].Trim(), 16)&0xFF);
            }
            catch {
                Console.WriteLine("overflow 3");
            }
            try {
                //testa ext och rtr!
               
                for (int i = 0; i < split.Length-3; i++) {
                    string dummy = split[i+3].Trim();
                    if (dummy.Length == 0) break;
                    data_length = (byte)((i+1)&0xFF);
                    //Console.WriteLine("i: " + i + " i+3: " + (i+3) + " split[i+3]: " +split[i+3]);
                    data[i] = (byte)(System.Convert.ToUInt32(dummy, 16)&0xFF);
                }
            }
            catch {
                Console.WriteLine("overflow 4");
            }
        }
       
    }
   
    public override int GetHashCode() {
        return base.GetHashCode();
    }
   
    public override bool  Equals(Object obj) {
        CanPacket cpm = (CanPacket)obj;
       
        byte[] bytes = cpm.getData();
       
        for(int i=0;i<8;i++) if (this.data[i]!=bytes[i]) return false;
       
        return (this.id==cpm.getId() && this.data_length==cpm.getDataLength());
       
    }
   
    public uint getId() { return this.id; }
    public void setId(uint id) { this.id = id; }
    public byte getPktClass(){ return this.pktclass; }
    public void setDataLength(byte datalength){ this.data_length=datalength; }
    public byte getDataLength(){ return this.data_length; }
    public byte[] getData(){ return this.data; }
    public void setExt(byte ext) { this.ext = ext; }
 
    public void setData(byte[] data){ this.data = data; }
   
//  public override string ToString() {
//      string str = "";
       
//      str = "pktclass: "+pktclass.ToString()+", type: "+type.ToString()+", sid: "+sid.ToString()+", rid: "+rid.ToString()+",data_length: "+data_length.ToString()+", data: ";
//      for (int i = 0; i < 8; i++) str+=data[i].ToString()+" ";
       
//      return str;
//  }
   
    public string toRawString() {
 
        string returnstring = "PKT " + String.Format("{0:x8}", id);
        returnstring = returnstring + " " + String.Format("{0:x1}", ext) + " " + String.Format("{0:x1}", rtr);
        for (int i = 0; i < data_length; i++) {
            returnstring = returnstring + " " + String.Format("{0:x2}", data[i]);
        }
        //returnstring = returnstring + "\n";
        return returnstring;
    }
   
    public byte[] getBytes() {
        byte[] bytes = new byte[15];
       
        // 17 bytes, a packet.
        // UART_START_BYTE id[0] id[1] id[2] id[3] extended remote_request data_length d[0] d[1] d[2] d[3] d[4] d[5] d[6] d[7] UART_END_BYTE
        /*
        * 000CCCCx TTTTTTTT SSSSSSSS RRRRRRRR
        *
        * <CLASS> = 00011110 00000000 00000000 00000000 = 0x1E000000    NMT, ...
        * <TYPE>  = 00000000 11111111 00000000 00000000 = 0x00FF0000    NMT[CAN_NMT_PGM_START, CAN_ID_NMT_PGM_ACK, ...]
        * <SID>   = 00000000 00000000 11111111 00000000 = 0x0000FF00    Sender ID
        * <RID>   = 00000000 00000000 00000000 11111111 = 0x000000FF    Receiver ID
        *
        */
       
       
        bytes[3] = (byte)((id & 0xFF000000) >> 24);
        bytes[2] = (byte)((id & 0x00FF0000) >> 16);
        bytes[1] = (byte)((id & 0x0000FF00) >> 8);
        bytes[0] = (byte)((id & 0x000000FF));
        bytes[4]=ext;
        bytes[5]=rtr;
        bytes[6]=this.data_length;
        for(int i=0;i<8;i++) bytes[i+7]=this.data[i];
       
        return bytes;
    }
   
}
 

Subversion Repositories HomeAutomation

(root)/branches/modules/PcSoftware/csharp-lib/CanPacket.cs – Rev 457 → 800

Rev 457		Rev 800
1	using System;	1	using System;
2	using System.Collections.Generic;	2	using System.Collections.Generic;
3	using System.Text;	3	using System.Text;
4		4
5	public class CanPacket {	5	public class CanPacket {
6	private byte pktclass = 0;	6	private byte pktclass = 0;
7	// private byte type = 0;	7	// private byte type = 0;
8	// private byte sid = 0;	8	// private byte sid = 0;
9	// private byte rid = 0;	9	// private byte rid = 0;
10	private byte data_length = 0;	10	private byte data_length = 0;
11	private uint id = 0;	11	private uint id = 0;
12	private byte[] data = new byte[8];	12	private byte[] data = new byte[8];
13	private byte ext = 1;	13	private byte ext = 1;
14	private byte rtr = 0;	14	private byte rtr = 0;
15		15
16	public CanPacket() {	16	public CanPacket() {
17		17
18	}	18	}
19		19
20	public CanPacket(byte[] raw,uint startIndex) {	20	public CanPacket(byte[] raw,uint startIndex) {
21	// 17 bytes, a packet.	21	// 17 bytes, a packet.
22	// UART_START_BYTE id[0] id[1] id[2] id[3] extended remote_request data_length d[0] d[1] d[2] d[3] d[4] d[5] d[6] d[7] UART_END_BYTE	22	// UART_START_BYTE id[0] id[1] id[2] id[3] extended remote_request data_length d[0] d[1] d[2] d[3] d[4] d[5] d[6] d[7] UART_END_BYTE
23	/*	23	/*
24	* 000CCCCx TTTTTTTT SSSSSSSS RRRRRRRR	24	* 000CCCCx TTTTTTTT SSSSSSSS RRRRRRRR
25	*	25	*
26	* <CLASS> = 00011110 00000000 00000000 00000000 = 0x1E000000 NMT, ...	26	* <CLASS> = 00011110 00000000 00000000 00000000 = 0x1E000000 NMT, ...
27	* <TYPE> = 00000000 11111111 00000000 00000000 = 0x00FF0000 NMT[CAN_NMT_PGM_START, CAN_ID_NMT_PGM_ACK, ...]	27	* <TYPE> = 00000000 11111111 00000000 00000000 = 0x00FF0000 NMT[CAN_NMT_PGM_START, CAN_ID_NMT_PGM_ACK, ...]
28	* <SID> = 00000000 00000000 11111111 00000000 = 0x0000FF00 Sender ID	28	* <SID> = 00000000 00000000 11111111 00000000 = 0x0000FF00 Sender ID
29	* <RID> = 00000000 00000000 00000000 11111111 = 0x000000FF Receiver ID	29	* <RID> = 00000000 00000000 00000000 11111111 = 0x000000FF Receiver ID
30	*	30	*
31	*/	31	*/
32		32
33		33
34	uint addr = (((uint)raw[startIndex + 3]) << 24) + (((uint)raw[startIndex + 2]) << 16) + (((uint)raw[startIndex + 1]) << 8) + (((uint)raw[startIndex + 0]));	34	uint addr = (((uint)raw[startIndex + 3]) << 24) + (((uint)raw[startIndex + 2]) << 16) + (((uint)raw[startIndex + 1]) << 8) + (((uint)raw[startIndex + 0]));
35		35
36	this.id = addr;	36	this.id = addr;
37	this.pktclass = (byte)((addr & 0x1E000000) >> 25);	37	this.pktclass = (byte)((addr & 0x1E000000) >> 25);
38	// this.type = (byte)((addr & 0x00FF0000) >> 16);	38	// this.type = (byte)((addr & 0x00FF0000) >> 16);
39	// this.sid = (byte)((addr & 0x0000FF00) >> 8);	39	// this.sid = (byte)((addr & 0x0000FF00) >> 8);
40	// this.rid = (byte)((addr & 0x000000FF));	40	// this.rid = (byte)((addr & 0x000000FF));
41	this.data_length = raw[startIndex + 6];	41	this.data_length = raw[startIndex + 6];
42		42
43	ext = (byte)(0x0f & raw[startIndex + 4]);	43	ext = (byte)(0x0f & raw[startIndex + 4]);
44	rtr = (byte)(0x0f & raw[startIndex + 5]);	44	rtr = (byte)(0x0f & raw[startIndex + 5]);
45		45
46	for (int i = 0; i < 8; i++) this.data[i] = raw[startIndex + 7 + i];	46	for (int i = 0; i < 8; i++) this.data[i] = raw[startIndex + 7 + i];
47	}	47	}
48		48
49	public CanPacket(string raw) {	49	public CanPacket(string raw) {
50	//denna funktion fungerar sådär, se till att bygga en bättre parser	50	//denna funktion fungerar sådär, se till att bygga en bättre parser
51		51
52	//1e00007f 1 0 04 03 02 01 96 3f 76 15	52	//1e00007f 1 0 04 03 02 01 96 3f 76 15
53	string [] split = null;	53	string [] split = null;
54	split = raw.Split( new Char [] {' '} );	54	split = raw.Split( new Char [] {' '} );
55	if ((split.Length >= 3) && (split.Length <= 11)) {	55	if ((split.Length >= 3) && (split.Length <= 11)) {
56	try {	56	try {
57	id = System.Convert.ToUInt32(split[0].Trim(), 16);	57	id = System.Convert.ToUInt32(split[0].Trim(), 16);
58	}	58	}
59	catch {	59	catch {
60	Console.WriteLine("overflow 1");	60	Console.WriteLine("overflow 1");
61	}	61	}
62	try {	62	try {
63	ext = (byte)(System.Convert.ToUInt32(split[1].Trim(), 16)&0xFF);	63	ext = (byte)(System.Convert.ToUInt32(split[1].Trim(), 16)&0xFF);
64	}	64	}
65	catch {	65	catch {
66	Console.WriteLine("overflow 2");	66	Console.WriteLine("overflow 2");
67	}	67	}
68	try {	68	try {
69	rtr = (byte)(System.Convert.ToUInt32(split[2].Trim(), 16)&0xFF);	69	rtr = (byte)(System.Convert.ToUInt32(split[2].Trim(), 16)&0xFF);
70	}	70	}
71	catch {	71	catch {
72	Console.WriteLine("overflow 3");	72	Console.WriteLine("overflow 3");
73	}	73	}
74	try {	74	try {
75	//testa ext och rtr!	75	//testa ext och rtr!
76		76
77	for (int i = 0; i < split.Length-3; i++) {	77	for (int i = 0; i < split.Length-3; i++) {
78	string dummy = split[i+3].Trim();	78	string dummy = split[i+3].Trim();
79	if (dummy.Length == 0) break;	79	if (dummy.Length == 0) break;
80	data_length = (byte)((i+1)&0xFF);	80	data_length = (byte)((i+1)&0xFF);
81	//Console.WriteLine("i: " + i + " i+3: " + (i+3) + " split[i+3]: " +split[i+3]);	81	//Console.WriteLine("i: " + i + " i+3: " + (i+3) + " split[i+3]: " +split[i+3]);
82	data[i] = (byte)(System.Convert.ToUInt32(dummy, 16)&0xFF);	82	data[i] = (byte)(System.Convert.ToUInt32(dummy, 16)&0xFF);
83	}	83	}
84	}	84	}
85	catch {	85	catch {
86	Console.WriteLine("overflow 4");	86	Console.WriteLine("overflow 4");
87	}	87	}
88	}	88	}
89		89
90	}	90	}
91		91
92	public override int GetHashCode() {	92	public override int GetHashCode() {
93	return base.GetHashCode();	93	return base.GetHashCode();
94	}	94	}
95		95
96	public override bool Equals(Object obj) {	96	public override bool Equals(Object obj) {
97	CanPacket cpm = (CanPacket)obj;	97	CanPacket cpm = (CanPacket)obj;
98		98
99	byte[] bytes = cpm.getData();	99	byte[] bytes = cpm.getData();
100		100
101	for(int i=0;i<8;i++) if (this.data[i]!=bytes[i]) return false;	101	for(int i=0;i<8;i++) if (this.data[i]!=bytes[i]) return false;
102		102
103	return (this.id==cpm.getId() && this.data_length==cpm.getDataLength());	103	return (this.id==cpm.getId() && this.data_length==cpm.getDataLength());
104		104
105	}	105	}
106		106
107	public uint getId() { return this.id; }	107	public uint getId() { return this.id; }
108	public void setId(uint id) { this.id = id; }	108	public void setId(uint id) { this.id = id; }
109	public byte getPktClass(){ return this.pktclass; }	109	public byte getPktClass(){ return this.pktclass; }
110	public void setDataLength(byte datalength){ this.data_length=datalength; }	110	public void setDataLength(byte datalength){ this.data_length=datalength; }
111	public byte getDataLength(){ return this.data_length; }	111	public byte getDataLength(){ return this.data_length; }
112	public byte[] getData(){ return this.data; }	112	public byte[] getData(){ return this.data; }
113	public void setExt(byte ext) { this.ext = ext; }	113	public void setExt(byte ext) { this.ext = ext; }
114		114
115	public void setData(byte[] data){ this.data = data; }	115	public void setData(byte[] data){ this.data = data; }
116		116
117	// public override string ToString() {	117	// public override string ToString() {
118	// string str = "";	118	// string str = "";
119		119
120	// str = "pktclass: "+pktclass.ToString()+", type: "+type.ToString()+", sid: "+sid.ToString()+", rid: "+rid.ToString()+",data_length: "+data_length.ToString()+", data: ";	120	// str = "pktclass: "+pktclass.ToString()+", type: "+type.ToString()+", sid: "+sid.ToString()+", rid: "+rid.ToString()+",data_length: "+data_length.ToString()+", data: ";
121	// for (int i = 0; i < 8; i++) str+=data[i].ToString()+" ";	121	// for (int i = 0; i < 8; i++) str+=data[i].ToString()+" ";
122		122
123	// return str;	123	// return str;
124	// }	124	// }
125		125
126	public string toRawString() {	126	public string toRawString() {
127		127
128	string returnstring = "PKT " + String.Format("{0:x8}", id);	128	string returnstring = "PKT " + String.Format("{0:x8}", id);
129	returnstring = returnstring + " " + String.Format("{0:x1}", ext) + " " + String.Format("{0:x1}", rtr);	129	returnstring = returnstring + " " + String.Format("{0:x1}", ext) + " " + String.Format("{0:x1}", rtr);
130	for (int i = 0; i < data_length; i++) {	130	for (int i = 0; i < data_length; i++) {
131	returnstring = returnstring + " " + String.Format("{0:x2}", data[i]);	131	returnstring = returnstring + " " + String.Format("{0:x2}", data[i]);
132	}	132	}
133	//returnstring = returnstring + "\n";	133	//returnstring = returnstring + "\n";
134	return returnstring;	134	return returnstring;
135	}	135	}
136		136
137	public byte[] getBytes() {	137	public byte[] getBytes() {
138	byte[] bytes = new byte[15];	138	byte[] bytes = new byte[15];
139		139
140	// 17 bytes, a packet.	140	// 17 bytes, a packet.
141	// UART_START_BYTE id[0] id[1] id[2] id[3] extended remote_request data_length d[0] d[1] d[2] d[3] d[4] d[5] d[6] d[7] UART_END_BYTE	141	// UART_START_BYTE id[0] id[1] id[2] id[3] extended remote_request data_length d[0] d[1] d[2] d[3] d[4] d[5] d[6] d[7] UART_END_BYTE
142	/*	142	/*
143	* 000CCCCx TTTTTTTT SSSSSSSS RRRRRRRR	143	* 000CCCCx TTTTTTTT SSSSSSSS RRRRRRRR
144	*	144	*
145	* <CLASS> = 00011110 00000000 00000000 00000000 = 0x1E000000 NMT, ...	145	* <CLASS> = 00011110 00000000 00000000 00000000 = 0x1E000000 NMT, ...
146	* <TYPE> = 00000000 11111111 00000000 00000000 = 0x00FF0000 NMT[CAN_NMT_PGM_START, CAN_ID_NMT_PGM_ACK, ...]	146	* <TYPE> = 00000000 11111111 00000000 00000000 = 0x00FF0000 NMT[CAN_NMT_PGM_START, CAN_ID_NMT_PGM_ACK, ...]
147	* <SID> = 00000000 00000000 11111111 00000000 = 0x0000FF00 Sender ID	147	* <SID> = 00000000 00000000 11111111 00000000 = 0x0000FF00 Sender ID
148	* <RID> = 00000000 00000000 00000000 11111111 = 0x000000FF Receiver ID	148	* <RID> = 00000000 00000000 00000000 11111111 = 0x000000FF Receiver ID
149	*	149	*
150	*/	150	*/
151		151
152		152
153	bytes[3] = (byte)((id & 0xFF000000) >> 24);	153	bytes[3] = (byte)((id & 0xFF000000) >> 24);
154	bytes[2] = (byte)((id & 0x00FF0000) >> 16);	154	bytes[2] = (byte)((id & 0x00FF0000) >> 16);
155	bytes[1] = (byte)((id & 0x0000FF00) >> 8);	155	bytes[1] = (byte)((id & 0x0000FF00) >> 8);
156	bytes[0] = (byte)((id & 0x000000FF));	156	bytes[0] = (byte)((id & 0x000000FF));
157	bytes[4]=ext;	157	bytes[4]=ext;
158	bytes[5]=rtr;	158	bytes[5]=rtr;
159	bytes[6]=this.data_length;	159	bytes[6]=this.data_length;
160	for(int i=0;i<8;i++) bytes[i+7]=this.data[i];	160	for(int i=0;i<8;i++) bytes[i+7]=this.data[i];
161		161
162	return bytes;	162	return bytes;
163	}	163	}
164		164
165	}	165	}
166		166