/*
* Status will be set to IDLE after valid frame is processed.
*/
private void HandleInFrame(FrameBuffer ifrm)
{
UInt32 value;
if (ifrm.cmd == 'W') //write by bytes
{
for (int j = 0; j < ifrm.datalen; j = j + 2)
{
try
{
/*
* just replace the specified 8 bits in register
*/
string name = reg_pos2name_tbl[ifrm.data[j]];
value = 0;
if (curr_conf[name].HasValue)
{
value = curr_conf[name].Value;
}
UInt32 multiplier = reg_mulitply_tbl[ifrm.data[j]];
valfresh[name] = true;
curr_conf[name] = 256 * multiplier * (UInt32)(value / (256 * multiplier)) + multiplier * ifrm.data[j + 1] + (value % multiplier);
}
catch (System.Exception e)
{
Program.MsgShow(e.Message);
}
}
status = NodeStatus.ST_IDLE;
}
#region obsolete_readword_code
/*
* if (ifrm.cmd == 'X')
* {
* for (int j = 0; j < ifrm.framelen;j=j+3 )
* {
* try
* {
* //queryEvent(ifrm.data[j], (UInt32)(ifrm.data[j + 1]) * 256 + (UInt32)(ifrm.data[j + 2]));
* }
* catch (System.Exception e)
* {
* Program.MsgBox(e.Message);
* }
* }
* }
*/
#endregion
}
private void write_vregs(string[] names, UInt32[] values)
{
FrameBuffer ofrm = new FrameBuffer();
ofrm.cmd = (byte)'W';
if (!curr_conf["addr"].HasValue)
{
throw new Exception("Invalid node address");
}
ofrm.addr = (byte)curr_conf["addr"].Value;
byte[] regbuffer = new byte[16];
byte[] valbuffer = new byte[16];
byte[] outbuffer = new byte[32];
int outptr = 0;
for (int i = 0; i < names.GetLength(0); i++)
{
if (reg_type_tbl[names[i]].size == 8)
{
regbuffer[outptr] = reg_type_tbl[names[i]].pos;
valbuffer[outptr] = (byte)values[i];
outptr++;
}
if (reg_type_tbl[names[i]].size == 16)
{
valbuffer[outptr] = (byte)(values[i] % 256);
valbuffer[outptr + 1] = (byte)(values[i] / 256);
regbuffer[outptr] = reg_type_tbl[names[i]].pos;
regbuffer[outptr + 1] = (byte)(regbuffer[outptr] + 1);
outptr = outptr + 2;
}
if (reg_type_tbl[names[i]].size == 32)
{
valbuffer[outptr + 0] = (byte)(values[i] % 256);
values[i] = (UInt32)(values[i] / 256);
valbuffer[outptr + 1] = (byte)(values[i] % 256);
values[i] = (UInt32)(values[i] / 256);
valbuffer[outptr + 2] = (byte)(values[i] % 256);
values[i] = (UInt32)(values[i] / 256);
valbuffer[outptr + 3] = (byte)(values[i] % 256);
regbuffer[outptr] = reg_type_tbl[names[i]].pos;
regbuffer[outptr + 1] = (byte)(regbuffer[outptr] + 1);
regbuffer[outptr + 2] = (byte)(regbuffer[outptr] + 2);
regbuffer[outptr + 3] = (byte)(regbuffer[outptr] + 3);
outptr = outptr + 4;
}
}
ofrm.generate_write_frame(outbuffer, regbuffer, valbuffer, 0, (byte)(outptr));
port.AddVCommand(outbuffer);
}
public SPort(string PortName, int BaudRate, Parity Parity, int DataBits, StopBits StopBit)
{
_serial = new SerialPort(PortName, BaudRate, Parity, DataBits, StopBit);
_serial.DataReceived += new SerialDataReceivedEventHandler(_serial_DataReceived);
_serial.Handshake = Handshake.None;
CmdToSend = new Queue <byte[]>();
InFrameHandlers = new Dictionary <byte, IOInFrameHandler>();
ifrm = new FrameBuffer();
ifrm.ResetFlag();
Status = PortStatus.CLOSED;
}
//write to register with absolute address, for bootloader use
public void writebyte_abs_reg(byte[] regaddr, byte[] value)
{
FrameBuffer ofrm = new FrameBuffer();
ofrm.cmd = (byte)'W';
ofrm.addr = this.node_id;
byte[] regbuffer = new byte[16];
byte[] valbuffer = new byte[16];
byte[] outbuffer = new byte[32];
int outptr = 0;
for (int i = 0; i < regaddr.GetLength(0); i++)
{
regbuffer[outptr] = regaddr[i];
valbuffer[outptr] = (byte)value[i];
outptr++;
}
ofrm.generate_write_frame(outbuffer, regbuffer, valbuffer, 0, (byte)(outptr));
port.AddVCommand(outbuffer);
}
//write to group address
public void writebyte_group_reg(byte group_addr, string[] regaddr, byte[] value)
{
FrameBuffer ofrm = new FrameBuffer();
ofrm.cmd = (byte)'W';
ofrm.addr = group_addr;
byte[] regbuffer = new byte[16];
byte[] valbuffer = new byte[16];
byte[] outbuffer = new byte[32];
int outptr = 0;
for (int i = 0; i < regaddr.GetLength(0); i++)
{
regbuffer[outptr] = reg_type_tbl[regaddr[i]].pos;
valbuffer[outptr] = (byte)value[i];
outptr++;
}
ofrm.generate_write_frame(outbuffer, regbuffer, valbuffer, 0, (byte)(outptr));
port.AddVCommand(outbuffer);
}
/*
* Generate read frame and add to buffer
*/
protected void read_regs(string[] names)
{
FrameBuffer ofrm = new FrameBuffer();
ofrm.cmd = (byte)'R';
ofrm.addr = node_id;
byte[] regbuffer = new byte[16];
byte[] outbuffer = new byte[16];
int outptr = 0;
for (int i = 0; i < names.GetLength(0); i++)
{
if (reg_type_tbl[names[i]].size == 8)
{
regbuffer[outptr] = reg_type_tbl[names[i]].pos;
outptr++;
}
if (reg_type_tbl[names[i]].size == 16)
{
regbuffer[outptr] = reg_type_tbl[names[i]].pos;
regbuffer[outptr + 1] = (byte)(regbuffer[outptr] + 1);
outptr = outptr + 2;
}
if (reg_type_tbl[names[i]].size == 32)
{
regbuffer[outptr] = reg_type_tbl[names[i]].pos;
regbuffer[outptr + 1] = (byte)(regbuffer[outptr] + 1);
regbuffer[outptr + 2] = (byte)(regbuffer[outptr] + 2);
regbuffer[outptr + 3] = (byte)(regbuffer[outptr] + 3);
outptr = outptr + 4;
}
}
ofrm.generate_read_frame(outbuffer, regbuffer, 0, (byte)(outptr));
port.AddVCommand(outbuffer);
last_cmd = outbuffer;
}
public SPort(string PortName, int BaudRate, Parity Parity, int DataBits, StopBits StopBit)
{
_serial = new SerialPort(PortName, BaudRate, Parity, DataBits, StopBit);
_serial.DataReceived +=new SerialDataReceivedEventHandler(_serial_DataReceived);
_serial.Handshake = Handshake.None;
CmdToSend = new Queue<byte[]>();
InFrameHandlers = new Dictionary<byte, IOInFrameHandler>();
ifrm = new FrameBuffer();
ifrm.ResetFlag();
Status = PortStatus.CLOSED;
}
/*
* Status will be set to IDLE after valid frame is processed.
*/
private void HandleInFrame(FrameBuffer ifrm)
{
UInt32 value;
if (ifrm.cmd == 'W') //write by bytes
{
for (int j = 0; j < ifrm.datalen; j=j+2 )
{
try
{
/*
* just replace the specified 8 bits in register
*/
string name = reg_pos2name_tbl[ifrm.data[j]];
value = 0;
if (curr_conf[name].HasValue)
{
value = curr_conf[name].Value;
}
UInt32 multiplier = reg_mulitply_tbl[ifrm.data[j]];
valfresh[name] = true;
curr_conf[name] = 256 * multiplier * (UInt32)(value / (256 * multiplier)) + multiplier * ifrm.data[j + 1] + (value % multiplier);
}
catch (System.Exception e)
{
Program.MsgShow(e.Message);
}
}
status = NodeStatus.ST_IDLE;
}
#region obsolete_readword_code
/*
if (ifrm.cmd == 'X')
{
for (int j = 0; j < ifrm.framelen;j=j+3 )
{
try
{
//queryEvent(ifrm.data[j], (UInt32)(ifrm.data[j + 1]) * 256 + (UInt32)(ifrm.data[j + 2]));
}
catch (System.Exception e)
{
Program.MsgBox(e.Message);
}
}
}
*/
#endregion
}
/*
* Generate read frame and add to buffer
*/
protected void read_regs(string[] names)
{
FrameBuffer ofrm = new FrameBuffer();
ofrm.cmd = (byte)'R';
ofrm.addr = node_id;
byte[] regbuffer = new byte[16];
byte[] outbuffer = new byte[16];
int outptr = 0;
for (int i = 0; i < names.GetLength(0); i++)
{
if (reg_type_tbl[names[i]].size == 8)
{
regbuffer[outptr] = reg_type_tbl[names[i]].pos;
outptr++;
}
if (reg_type_tbl[names[i]].size == 16)
{
regbuffer[outptr] = reg_type_tbl[names[i]].pos;
regbuffer[outptr + 1] = (byte)(regbuffer[outptr] + 1);
outptr = outptr + 2;
}
if (reg_type_tbl[names[i]].size == 32)
{
regbuffer[outptr] = reg_type_tbl[names[i]].pos;
regbuffer[outptr + 1] = (byte)(regbuffer[outptr] + 1);
regbuffer[outptr + 2] = (byte)(regbuffer[outptr] + 2);
regbuffer[outptr + 3] = (byte)(regbuffer[outptr] + 3);
outptr = outptr + 4;
}
}
ofrm.generate_read_frame(outbuffer, regbuffer, 0, (byte)(outptr));
port.AddVCommand(outbuffer);
last_cmd = outbuffer;
}
private void write_vregs(string[] names, UInt32[] values)
{
FrameBuffer ofrm = new FrameBuffer();
ofrm.cmd = (byte)'W';
if (!curr_conf["addr"].HasValue)
{
throw new Exception("Invalid node address");
}
ofrm.addr = (byte)curr_conf["addr"].Value;
byte[] regbuffer = new byte[16];
byte[] valbuffer = new byte[16];
byte[] outbuffer = new byte[32];
int outptr = 0;
for (int i = 0; i < names.GetLength(0); i++)
{
if (reg_type_tbl[names[i]].size == 8)
{
regbuffer[outptr] = reg_type_tbl[names[i]].pos;
valbuffer[outptr] = (byte)values[i];
outptr++;
}
if (reg_type_tbl[names[i]].size == 16)
{
valbuffer[outptr ] = (byte)(values[i] % 256);
valbuffer[outptr + 1] = (byte)(values[i] / 256);
regbuffer[outptr] = reg_type_tbl[names[i]].pos;
regbuffer[outptr + 1] = (byte)(regbuffer[outptr] + 1);
outptr = outptr + 2;
}
if (reg_type_tbl[names[i]].size == 32)
{
valbuffer[outptr + 0] = (byte)(values[i] % 256);
values[i] = (UInt32)(values[i] / 256);
valbuffer[outptr + 1] = (byte)(values[i] % 256);
values[i] = (UInt32)(values[i] / 256);
valbuffer[outptr + 2] = (byte)(values[i] % 256);
values[i] = (UInt32)(values[i] / 256);
valbuffer[outptr + 3] = (byte)(values[i] % 256);
regbuffer[outptr] = reg_type_tbl[names[i]].pos;
regbuffer[outptr + 1] = (byte)(regbuffer[outptr] + 1);
regbuffer[outptr + 2] = (byte)(regbuffer[outptr] + 2);
regbuffer[outptr + 3] = (byte)(regbuffer[outptr] + 3);
outptr = outptr + 4;
}
}
ofrm.generate_write_frame(outbuffer, regbuffer, valbuffer, 0, (byte)(outptr));
port.AddVCommand(outbuffer);
}
//write to register with absolute address, for bootloader use
public void writebyte_abs_reg(byte[] regaddr, byte[] value)
{
FrameBuffer ofrm = new FrameBuffer();
ofrm.cmd = (byte)'W';
ofrm.addr = this.node_id;
byte[] regbuffer = new byte[16];
byte[] valbuffer = new byte[16];
byte[] outbuffer = new byte[32];
int outptr = 0;
for (int i = 0; i < regaddr.GetLength(0); i++)
{
regbuffer[outptr] = regaddr[i];
valbuffer[outptr] = (byte)value[i];
outptr++;
}
ofrm.generate_write_frame(outbuffer, regbuffer, valbuffer, 0, (byte)(outptr));
port.AddVCommand(outbuffer);
}
//write to group address
public void writebyte_group_reg(byte group_addr, string[] regaddr, byte[] value)
{
FrameBuffer ofrm = new FrameBuffer();
ofrm.cmd = (byte)'W';
ofrm.addr = group_addr;
byte[] regbuffer = new byte[16];
byte[] valbuffer = new byte[16];
byte[] outbuffer = new byte[32];
int outptr = 0;
for (int i = 0; i < regaddr.GetLength(0); i++)
{
regbuffer[outptr] = reg_type_tbl[regaddr[i]].pos;
valbuffer[outptr] = (byte)value[i];
outptr++;
}
ofrm.generate_write_frame(outbuffer, regbuffer, valbuffer, 0, (byte)(outptr));
port.AddVCommand(outbuffer);
}
