MirrorSave
/
pigpio
mirror of https://github.com/joan2937/pigpio
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Allow 3-op script cmds to use regs as 3rd operand.

This commit is contained in:
Dan Brown 2017-12-01 22:32:44 -05:00
parent 8996b7eaca
commit 3edc87fea5
2 changed files with 14 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
command.c
View File

@ -890,11 +890,11 @@ int cmdParse(
*/
ctl->eaten += getNum(buf+ctl->eaten, &p[1], &ctl->opt[1]);
ctl->eaten += getNum(buf+ctl->eaten, &p[2], &ctl->opt[2]);
ctl->eaten += getNum(buf+ctl->eaten, &tp1, &to1);
ctl->eaten += getNum(buf+ctl->eaten, &tp1, &ctl->opt[3]);
if ((ctl->opt[1] > 0) && ((int)p[1] >= 0) &&
(ctl->opt[2] > 0) && ((int)p[2] >= 0) &&
(to1 == CMD_NUMERIC) && ((int)tp1 >= 0))
(ctl->opt[3] > 0) && ((int)tp1 >= 0))
{
p[3] = 4;
memcpy(ext, &tp1, 4);

12
pigpio.c
View File

@ -6496,7 +6496,7 @@ static void *pthScript(void *x)
{
gpioScript_t *s;
cmdInstr_t instr;
int p1, p2, p1o, p2o, *t1, *t2;
int p1, p2, p1o, p2o, p3o, *t1, *t2;
int PC, A, F, SP;
int S[PI_SCRIPT_STACK_SIZE];
char buf[CMD_MAX_EXTENSION];
@ -6541,9 +6541,19 @@ static void *pthScript(void *x)
if (instr.p[0] < 100)
{
if (instr.p[3])
{
if ((instr.p[3] == sizeof(int)) && ((instr.opt[3] == CMD_VAR) || (instr.opt[3] == CMD_PAR)))
{
/* Hack to allow register use in 3rd parameter */
memcpy((char*)&p3o, (char *)instr.p[4], sizeof(int));
if (instr.opt[3] == CMD_VAR) memcpy(buf, (char *)&(s->script.var[p3o]), sizeof(int));
else memcpy(buf, (char *)&(s->script.par[p3o]), sizeof(int));
}
else
{
memcpy(buf, (char *)instr.p[4], instr.p[3]);
}
}
A = myDoCommand(instr.p, sizeof(buf)-1, buf);