WebSVN – HomeAutomation – Diff – /trunk/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);
 
                ext = (byte)(System.Convert.ToUInt32(split[1].Trim(), 16)&0xFF);
                rtr = (byte)(System.Convert.ToUInt32(split[2].Trim(), 16)&0xFF);
               
                //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 ");
            }
        }
       
    }
 
//  public CanPacket(byte pktclass, byte type, byte sid, byte rid, byte data_length, byte[] data) { 
//      //keep for compability for a while (Downloader.cs)
//      this.id = ((uint)pktclass<<24)|((uint)type<<16)|((uint)sid<<8)|((uint)rid);
//      this.data_length=data_length;
//      ext = 1;
//      rtr = 0;
//      for(int i=0;i<8;i++) this.data[i]=data[i];
//  }
   
//  public CanPacket(byte pktclass, byte type, byte sid, byte rid, byte data_length, byte[] data, byte rtr, byte ext) { 
//      this.pktclass=pktclass;
//      this.type=type;
//      this.sid=sid;
//      this.rid=rid;
//      this.data_length=data_length;
//      for(int i=0;i<8;i++) this.data[i]=data[i];
//      this.ext = (byte)(0x0f & ext);
//      this.rtr = (byte)(0x0f & rtr);
//  }
   
    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 uint getType(){ return this.type; }
//  public uint getSid(){ return this.sid; }
//  public uint getRid(){ return this.sid; }
    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)/trunk/PcSoftware/csharp-lib/CanPacket.cs – Rev 450 → 453

Rev 450		Rev 453
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	ext = (byte)(System.Convert.ToUInt32(split[1].Trim(), 16)&0xFF);	59	ext = (byte)(System.Convert.ToUInt32(split[1].Trim(), 16)&0xFF);
60	rtr = (byte)(System.Convert.ToUInt32(split[2].Trim(), 16)&0xFF);	60	rtr = (byte)(System.Convert.ToUInt32(split[2].Trim(), 16)&0xFF);
61		61
62	//testa ext och rtr!	62	//testa ext och rtr!
63		63
64	for (int i = 0; i < split.Length-3; i++) {	64	for (int i = 0; i < split.Length-3; i++) {
65	string dummy = split[i+3].Trim();	65	string dummy = split[i+3].Trim();
66	if (dummy.Length == 0) break;	66	if (dummy.Length == 0) break;
67	data_length = (byte)((i+1)&0xFF);	67	data_length = (byte)((i+1)&0xFF);
68	//Console.WriteLine("i: " + i + " i+3: " + (i+3) + " split[i+3]: " +split[i+3]);	68	//Console.WriteLine("i: " + i + " i+3: " + (i+3) + " split[i+3]: " +split[i+3]);
69	data[i] = (byte)(System.Convert.ToUInt32(dummy, 16)&0xFF);	69	data[i] = (byte)(System.Convert.ToUInt32(dummy, 16)&0xFF);
70	}	70	}
71	}	71	}
72	catch {	72	catch {
73	Console.WriteLine("overflow ");	73	Console.WriteLine("overflow ");
74	}	74	}
75	}	75	}
76		76
77	}	77	}
-		78
-		79	// public CanPacket(byte pktclass, byte type, byte sid, byte rid, byte data_length, byte[] data) {
-		80	// //keep for compability for a while (Downloader.cs)
-		81	// this.id = ((uint)pktclass<<24)\|((uint)type<<16)\|((uint)sid<<8)\|((uint)rid);
-		82	// this.data_length=data_length;
-		83	// ext = 1;
-		84	// rtr = 0;
-		85	// for(int i=0;i<8;i++) this.data[i]=data[i];
-		86	// }
78		87
79	// public CanPacket(byte pktclass, byte type, byte sid, byte rid, byte data_length, byte[] data, byte rtr, byte ext) {	88	// public CanPacket(byte pktclass, byte type, byte sid, byte rid, byte data_length, byte[] data, byte rtr, byte ext) {
80	// this.pktclass=pktclass;	89	// this.pktclass=pktclass;
81	// this.type=type;	90	// this.type=type;
82	// this.sid=sid;	91	// this.sid=sid;
83	// this.rid=rid;	92	// this.rid=rid;
84	// this.data_length=data_length;	93	// this.data_length=data_length;
85	// for(int i=0;i<8;i++) this.data[i]=data[i];	94	// for(int i=0;i<8;i++) this.data[i]=data[i];
86	// this.ext = (byte)(0x0f & ext);	95	// this.ext = (byte)(0x0f & ext);
87	// this.rtr = (byte)(0x0f & rtr);	96	// this.rtr = (byte)(0x0f & rtr);
88	// }	97	// }
89		98
90	public override int GetHashCode() {	99	public override int GetHashCode() {
91	return base.GetHashCode();	100	return base.GetHashCode();
92	}	101	}
93		102
94	public override bool Equals(Object obj) {	103	public override bool Equals(Object obj) {
95	CanPacket cpm = (CanPacket)obj;	104	CanPacket cpm = (CanPacket)obj;
96		105
97	byte[] bytes = cpm.getData();	106	byte[] bytes = cpm.getData();
98		107
99	for(int i=0;i<8;i++) if (this.data[i]!=bytes[i]) return false;	108	for(int i=0;i<8;i++) if (this.data[i]!=bytes[i]) return false;
100		109
101	return (this.id==cpm.getId() && this.data_length==cpm.getDataLength());	110	return (this.id==cpm.getId() && this.data_length==cpm.getDataLength());
102		111
103	}	112	}
104		113
105	public uint getId() { return this.id; }	114	public uint getId() { return this.id; }
106	public void setId(uint id) { this.id = id; }	115	public void setId(uint id) { this.id = id; }
107	//public byte getPktClass(){ return this.pktclass; }	116	//public byte getPktClass(){ return this.pktclass; }
108	// public uint getType(){ return this.type; }	117	// public uint getType(){ return this.type; }
109	// public uint getSid(){ return this.sid; }	118	// public uint getSid(){ return this.sid; }
110	// public uint getRid(){ return this.sid; }	119	// public uint getRid(){ return this.sid; }
111	public void setDataLength(byte datalength){ this.data_length=datalength; }	120	public void setDataLength(byte datalength){ this.data_length=datalength; }
112	public byte getDataLength(){ return this.data_length; }	121	public byte getDataLength(){ return this.data_length; }
113	public byte[] getData(){ return this.data; }	122	public byte[] getData(){ return this.data; }
114	public void setExt(byte ext) { this.ext = ext; }	123	public void setExt(byte ext) { this.ext = ext; }
-		124
-		125	public void setData(byte[] data){ this.data = data; }
115		126
116	// public override string ToString() {	127	// public override string ToString() {
117	// string str = "";	128	// string str = "";
118		129
119	// str = "pktclass: "+pktclass.ToString()+", type: "+type.ToString()+", sid: "+sid.ToString()+", rid: "+rid.ToString()+",data_length: "+data_length.ToString()+", data: ";	130	// str = "pktclass: "+pktclass.ToString()+", type: "+type.ToString()+", sid: "+sid.ToString()+", rid: "+rid.ToString()+",data_length: "+data_length.ToString()+", data: ";
120	// for (int i = 0; i < 8; i++) str+=data[i].ToString()+" ";	131	// for (int i = 0; i < 8; i++) str+=data[i].ToString()+" ";
121		132
122	// return str;	133	// return str;
123	// }	134	// }
124		135
125	public string toRawString() {	136	public string toRawString() {
126		137
127	string returnstring = "PKT " + String.Format("{0:x8}", id);	138	string returnstring = "PKT " + String.Format("{0:x8}", id);
128	returnstring = returnstring + " " + String.Format("{0:x1}", ext) + " " + String.Format("{0:x1}", rtr);	139	returnstring = returnstring + " " + String.Format("{0:x1}", ext) + " " + String.Format("{0:x1}", rtr);
129	for (int i = 0; i < data_length; i++) {	140	for (int i = 0; i < data_length; i++) {
130	returnstring = returnstring + " " + String.Format("{0:x2}", data[i]);	141	returnstring = returnstring + " " + String.Format("{0:x2}", data[i]);
131	}	142	}
132	//returnstring = returnstring + "\n";	143	//returnstring = returnstring + "\n";
133	return returnstring;	144	return returnstring;
134	}	145	}
135		146
136	public byte[] getBytes() {	147	public byte[] getBytes() {
137	byte[] bytes = new byte[15];	148	byte[] bytes = new byte[15];
138		149
139	// 17 bytes, a packet.	150	// 17 bytes, a packet.
140	// 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	151	// 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	/*	152	/*
142	* 000CCCCx TTTTTTTT SSSSSSSS RRRRRRRR	153	* 000CCCCx TTTTTTTT SSSSSSSS RRRRRRRR
143	*	154	*
144	* <CLASS> = 00011110 00000000 00000000 00000000 = 0x1E000000 NMT, ...	155	* <CLASS> = 00011110 00000000 00000000 00000000 = 0x1E000000 NMT, ...
145	* <TYPE> = 00000000 11111111 00000000 00000000 = 0x00FF0000 NMT[CAN_NMT_PGM_START, CAN_ID_NMT_PGM_ACK, ...]	156	* <TYPE> = 00000000 11111111 00000000 00000000 = 0x00FF0000 NMT[CAN_NMT_PGM_START, CAN_ID_NMT_PGM_ACK, ...]
146	* <SID> = 00000000 00000000 11111111 00000000 = 0x0000FF00 Sender ID	157	* <SID> = 00000000 00000000 11111111 00000000 = 0x0000FF00 Sender ID
147	* <RID> = 00000000 00000000 00000000 11111111 = 0x000000FF Receiver ID	158	* <RID> = 00000000 00000000 00000000 11111111 = 0x000000FF Receiver ID
148	*	159	*
149	*/	160	*/
150		161
151		162
152	bytes[3] = (byte)((id & 0xFF000000) >> 24);	163	bytes[3] = (byte)((id & 0xFF000000) >> 24);
153	bytes[2] = (byte)((id & 0x00FF0000) >> 16);	164	bytes[2] = (byte)((id & 0x00FF0000) >> 16);
154	bytes[1] = (byte)((id & 0x0000FF00) >> 8);	165	bytes[1] = (byte)((id & 0x0000FF00) >> 8);
155	bytes[0] = (byte)((id & 0x000000FF));	166	bytes[0] = (byte)((id & 0x000000FF));
156	bytes[4]=ext;	167	bytes[4]=ext;
157	bytes[5]=rtr;	168	bytes[5]=rtr;
158	bytes[6]=this.data_length;	169	bytes[6]=this.data_length;
159	for(int i=0;i<8;i++) bytes[i+7]=this.data[i];	170	for(int i=0;i<8;i++) bytes[i+7]=this.data[i];
160		171
161	return bytes;	172	return bytes;
162	}	173	}
163		174
164	}	175	}
165		176