Nife version Beta
You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
 
 
 
 

2068 lines
44 KiB

  1. /* Copyright (C) 2011-2014 Patrick H. E. Foubet - S.E.R.I.A.N.E.
  2. This program is free software: you can redistribute it and/or modify
  3. it under the terms of the GNU General Public License as published by
  4. the Free Software Foundation, either version 3 of the License, or any
  5. later version.
  6. This program is distributed in the hope that it will be useful,
  7. but WITHOUT ANY WARRANTY; without even the implied warranty of
  8. MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  9. GNU General Public License for more details.
  10. You should have received a copy of the GNU General Public License
  11. along with this program. If not, see <http://www.gnu.org/licenses/>
  12. *******************************************************************/
  13. /* stackN.c */
  14. #include "conf.h"
  15. #include <stdio.h>
  16. #include <stdlib.h>
  17. #include <string.h>
  18. #include <strings.h>
  19. #include <sys/types.h>
  20. #include <math.h>
  21. #include "nife.h"
  22. #include "mth.h"
  23. #include "err.h"
  24. #include "lib.h"
  25. #include "stackN.h"
  26. #include "stackL.h"
  27. #include "stackF.h"
  28. #include "stackV.h"
  29. #include "debug.h"
  30. #include "net.h"
  31. #include "scs.h"
  32. #define _VERIF_STACK_ if (StackN == VIDE) { messErr(2); return; }
  33. void IF_vars(void)
  34. {
  35. char * L;
  36. printf("DEBUG : ");
  37. if (Debug) printf("ON"); else printf("OFF");
  38. printf("\nDefault type=");
  39. if (DOUBLE) printf("REAL"); else printf("INTEGER");
  40. printf("\nPRINT MODE : ");
  41. switch(MODEPR) {
  42. case 1 :
  43. printf("HEX");
  44. break;
  45. case 2 :
  46. printf("OCT");
  47. break;
  48. case 3 :
  49. printf("BIN");
  50. break;
  51. default :
  52. printf("DEC");
  53. break;
  54. }
  55. printf("\nDefault echo=");
  56. if (ECHOOFF) printf("OFF"); else printf("ON");
  57. printf("\nNetServer : \"%s\"",NetServer);
  58. printf("\nSCS Key : 0x%lx",(long)getScs());
  59. printf("\nNetKey : 0x%lx",(long)NetKey);
  60. printf("\nVARS : ");
  61. switch(VARS) {
  62. case 1 :
  63. printf("DOWN");
  64. break;
  65. case 2 :
  66. printf("UP");
  67. break;
  68. default :
  69. printf("OFF");
  70. break;
  71. }
  72. printf("\nVariable Function : ");
  73. if ((L=libByAddr(FCT_INST)) != NULL) printf("%s (std lib)",L);
  74. else {
  75. if ((L=fctByAddr(FCT_INST)) != NULL) printf("%s (user function)",L);
  76. else {
  77. if ((L=varByAddr(FCT_INST)) != NULL) printf("%s (variable)",L);
  78. else printf("none");
  79. }
  80. }
  81. printf("\nNBTAB=%d\nNBLIG=%d\n",NBTAB,NBLIG);
  82. }
  83. void IF_REAL(void) { _MODIF_DOUBLE_(1); }
  84. void IF_INTEGER(void) { _MODIF_DOUBLE_(0); }
  85. void IF_DEC(void) { _MODIF_MODEPR_(0); }
  86. void IF_HEX(void) { _MODIF_MODEPR_(1); }
  87. void IF_OCT(void) { _MODIF_MODEPR_(2); }
  88. void IF_BIN(void) { _MODIF_MODEPR_(3); }
  89. void IF_ECHOFF(void) { _MODIF_ECHOOFF_(1); }
  90. void IF_ECHOON(void) { _MODIF_ECHOOFF_(0); }
  91. /* IMPORTANT **************************
  92. la taille t est codee sur 30 bits + a droite
  93. B31 = 1 si Var
  94. B32 = 1 si REAL
  95. **********************/
  96. #define MSK_T (uint32_t)(0x3FFFFFFF)
  97. #define MSK_V (uint32_t)(0x40000000)
  98. #define MSK_R (uint32_t)(0x80000000)
  99. struct Num {
  100. uint32_t t; /* taille : cf precisions ci-dessus */
  101. uint32_t key; /* net key */
  102. void *n;
  103. union {
  104. long long l;
  105. double d;
  106. };
  107. };
  108. int lAdrNum(void)
  109. {
  110. struct Num N;
  111. return((char*)&(N.l) - (char*)&(N.n));
  112. }
  113. void putLong(long long l)
  114. {
  115. void * M;
  116. struct Num * N;
  117. if ((M = malloc(sizeof(struct Num))) == NULL) stopErr("putLong","malloc");
  118. N = (struct Num*)M;
  119. N->t = 1;
  120. N->n = StackN;
  121. N->l = l;
  122. _MODIF_STACKN_(M);
  123. }
  124. void putDouble(double d)
  125. {
  126. void * M;
  127. struct Num * N;
  128. if ((M = malloc(sizeof(struct Num))) == NULL) stopErr("putDouble","malloc");
  129. N = (struct Num*)M;
  130. N->t = 1 | MSK_R;
  131. N->n = StackN;
  132. N->d = d;
  133. _MODIF_STACKN_(M);
  134. }
  135. int putVal(char *V)
  136. {
  137. void * M;
  138. char * R;
  139. struct Num * N;
  140. long long l;
  141. double d;
  142. #ifdef DEBUG
  143. printf("putVal (%s) \n",V);
  144. #endif
  145. l = strtoll(V,&R,0);
  146. if (strlen(R)==0) {
  147. if ((M = malloc(sizeof(struct Num))) == NULL) stopErr("putVal","malloc");
  148. N = (struct Num*)M;
  149. N->t = 1;
  150. N->n = StackN;
  151. N->l = l;
  152. if (fctEnCours) makeFct(T_NUM,M);
  153. else _MODIF_STACKN_(M);
  154. return 1;
  155. } else {
  156. d = strtod(V,&R);
  157. if (strlen(R)==0) {
  158. if ((M=malloc(sizeof(struct Num))) == NULL) stopErr("putVal","malloc");
  159. N = (struct Num*)M;
  160. N->t = 1 | MSK_R;
  161. N->n = StackN;
  162. N->d = d;
  163. if (fctEnCours) makeFct(T_NUM,M);
  164. else _MODIF_STACKN_(M);
  165. return 1;
  166. }
  167. }
  168. return 0;
  169. }
  170. static int isScalar(void)
  171. {
  172. struct Num *Elt;
  173. int t;
  174. if(StackN == VIDE) return 0;
  175. Elt = (struct Num *)StackN;
  176. if ((t = Elt->t&MSK_T) == 1) return 1;
  177. return 0;
  178. }
  179. static int dropElt(void)
  180. {
  181. struct Num *Elt;
  182. if(StackN == VIDE) return 0;
  183. Elt = (struct Num *)StackN;
  184. _MODIF_STACKN_(Elt->n);
  185. if (!(Elt->t&MSK_V)) free((void*)Elt);
  186. return 1;
  187. }
  188. void IF_drop(void)
  189. {
  190. _VERIF_STACK_
  191. dropElt();
  192. }
  193. static long long getVal(void)
  194. {
  195. struct Num *Elt;
  196. Elt = (struct Num *)StackN;
  197. if (Elt->t & MSK_R) return((long long)Elt->d);
  198. else return(Elt->l);
  199. }
  200. void IF_vers(void)
  201. {
  202. putDouble(atof(VERSION));
  203. }
  204. /* fonction pour les autres */
  205. int getParLong(long *V)
  206. {
  207. if (StackN == VIDE) {
  208. messErr(2); return 0 ;
  209. }
  210. if (!isScalar()) {
  211. messErr(36); return 0 ;
  212. }
  213. *V = (long)getVal();
  214. dropElt();
  215. return 1;
  216. }
  217. void putVar(void * V)
  218. {
  219. struct Num *Elt;
  220. if (V==VIDE) return;
  221. Elt = (struct Num *)V;
  222. Elt->n = StackN;
  223. _MODIF_STACKN_(V);
  224. }
  225. void * getVar(void)
  226. {
  227. void * N;
  228. struct Num *Elt;
  229. N = StackN;
  230. if (N != VIDE) {
  231. Elt = (struct Num *)N;
  232. _MODIF_STACKN_(Elt->n); /* drop no free !! */
  233. Elt->n = VIDE;
  234. Elt->t = Elt->t|MSK_V; /* VARIABLE ! */
  235. }
  236. return N;
  237. }
  238. void IF_NBTAB(void)
  239. {
  240. long V;
  241. if (getParLong(&V)) _MODIF_NBTAB_(V);
  242. }
  243. void IF_NBLIG(void)
  244. {
  245. long V;
  246. if (getParLong(&V)) _MODIF_NBLIG_(V);
  247. }
  248. void IF_VAROFF(void) { _MODIF_VARS_(0); }
  249. void IF_VARDOWN(void) { _MODIF_VARS_(1); }
  250. void IF_VARUP(void) { _MODIF_VARS_(2); }
  251. void insertVal(void*A)
  252. {
  253. void * M;
  254. struct Num *Elt;
  255. if ((M = malloc(sizeof(struct Num))) == NULL) stopErr("insertVal","malloc");
  256. bcopy(A,M,sizeof(struct Num));
  257. Elt=(struct Num*)M;
  258. Elt->n = StackN;
  259. _MODIF_STACKN_(M);
  260. }
  261. static void Ramp(int D)
  262. {
  263. long n, i, dep=1;
  264. void * M;
  265. struct Num * N;
  266. long long *T;
  267. _VERIF_STACK_
  268. if (!isScalar()) {
  269. messErr(36); return;
  270. }
  271. n = (long)getVal();
  272. dropElt();
  273. if (n > 1) {
  274. if (D) { /* double ramp */
  275. dep = -n;
  276. n = (2*n) +1;
  277. }
  278. if ((M = malloc(sizeof(struct Num)+((n-1)*(sizeof(double))))) == NULL)
  279. stopErr("Ramp","malloc");
  280. N = (struct Num*)M;
  281. N->t = n;
  282. N->n = StackN;
  283. _MODIF_STACKN_(M);
  284. T = &(N->l);
  285. for(i=0;i<n;i++) T[i]=i+dep;
  286. } else messErr(30);
  287. }
  288. void IF_ramp(void)
  289. {
  290. Ramp(0);
  291. }
  292. void IF_dramp(void)
  293. {
  294. Ramp(1);
  295. }
  296. void IF_stack_clear(void)
  297. {
  298. while (StackN != VIDE) dropElt();
  299. }
  300. static printLL(char * F, long long l)
  301. {
  302. char c, buf[68];
  303. unsigned long long v;
  304. int i;
  305. switch(MODEPR) {
  306. case 1 :
  307. c='x';
  308. printf("0x");
  309. break;
  310. case 2 :
  311. c='o';
  312. printf("0");
  313. break;
  314. case 3 :
  315. c='b';
  316. break;
  317. default :
  318. c='d';
  319. }
  320. if (c =='b') {
  321. if (l) {
  322. v = (unsigned long long)l;
  323. buf[67]='\0';
  324. i = 67;
  325. while (v) {
  326. i--;
  327. if (v & 1) buf[i]='1';
  328. else buf[i]='0';
  329. v >>= 1;
  330. }
  331. printf("%s ",buf+i);
  332. } else printf("0 ");
  333. } else {
  334. strcpy(buf,F);
  335. buf[3]=c;
  336. printf(buf,l);
  337. }
  338. }
  339. #define ELT_POINT -9
  340. static void printElt(struct Num * N, long I)
  341. {
  342. long n, i, m, nt, IB;
  343. long long *l;
  344. double *d;
  345. IB = I;
  346. n = N->t&MSK_T;
  347. if (IB < 0) nt = 3;
  348. else nt = NBTAB;
  349. if (n > nt) m=nt-1;
  350. else m=n-1;
  351. if (I==ELT_POINT) {
  352. IB=0;
  353. n=2;
  354. m=1;
  355. }
  356. if (IB) printf(" ");
  357. if(N->t & MSK_R) {
  358. if (n==1) printf("%g (REAL)",N->d);
  359. else {
  360. d = &N->d;
  361. for(i=0;i<m;i++) printf("%g ",*d++);
  362. if (I==ELT_POINT) return;
  363. if (n > nt) printf("... ");
  364. printf("%g (REAL)[%ld]",*(&N->d+(n-1)),n);
  365. }
  366. } else {
  367. if (n==1) {
  368. printLL("%lld ",N->l);
  369. printf("(INTEGER)");
  370. } else {
  371. l = &N->l;
  372. for(i=0;i<m;i++) printLL("%lld ",*l++);
  373. if (I==ELT_POINT) return;
  374. if (n > nt) printf("... ");
  375. printLL("%lld ",*(&N->l+(n-1)));
  376. printf("(INTEGER)[%ld]",n);
  377. }
  378. }
  379. if ((IB>0) && (N->t&MSK_V)) printf(" Var. %s",varByAddrA((void*)N));
  380. if (IB==1) printf(" <- top");
  381. if (IB) printf("\n");
  382. }
  383. void printNumber(void * E)
  384. {
  385. printElt((struct Num*)E, 0);
  386. }
  387. void numVarOff(void * A)
  388. {
  389. struct Num * N;
  390. N = (struct Num*) A;
  391. N->t = N->t & ~MSK_V;
  392. }
  393. void IF_show_stack(void)
  394. {
  395. void * Next;
  396. struct Num * N;
  397. long i=0,Nbl;
  398. char s;
  399. Nbl=NBLIG;
  400. Next = StackN;
  401. while (Next != VIDE) {
  402. N = (struct Num*) Next;
  403. i++;
  404. if (i<=Nbl) printElt(N,i);
  405. Next = N->n;
  406. }
  407. if (i<=Nbl) printf("<end of stack>\n");
  408. else {
  409. if (i==Nbl+1) s = ' ';
  410. else s = 's';
  411. printf(" ... and %ld other%c element%c !\n",i-Nbl,s,s);
  412. }
  413. }
  414. void IF_point(void)
  415. {
  416. struct Num *Elt;
  417. _VERIF_STACK_
  418. Elt = (struct Num *)StackN;
  419. printElt(Elt,ELT_POINT);
  420. /* printf("\n"); */
  421. dropElt();
  422. }
  423. void * duplicateNum(void * S, int vSoff)
  424. {
  425. struct Num *Elt, *NElt;
  426. void * M;
  427. uint32_t n;
  428. int s;
  429. Elt = (struct Num*)S;
  430. n = Elt->t&MSK_T;
  431. s = sizeof(struct Num)+((n-1)*(sizeof(double)));
  432. if ((M = malloc(s)) == NULL) stopErr("dupElt","malloc");
  433. bcopy((void*)Elt,M,s);
  434. NElt = (struct Num *)M;
  435. NElt->n = VIDE;
  436. NElt->t = Elt->t;
  437. if (vSoff) Elt->t = Elt->t & ~MSK_V; /* Source no more a Var */
  438. return(M);
  439. }
  440. static void dupElt(struct Num * Elt)
  441. {
  442. struct Num *NElt;
  443. void * M;
  444. uint32_t n;
  445. int s;
  446. n = Elt->t&MSK_T;
  447. s = sizeof(struct Num)+((n-1)*(sizeof(double)));
  448. if ((M = malloc(s)) == NULL) stopErr("dupElt","malloc");
  449. bcopy((void*)Elt,M,s);
  450. NElt = (struct Num *)M;
  451. NElt->n = StackN;
  452. NElt->t = Elt->t & ~MSK_V; /* au cas ou Var */
  453. _MODIF_STACKN_(M);
  454. }
  455. void IF_dup(void)
  456. {
  457. _VERIF_STACK_
  458. dupElt((struct Num *)StackN);
  459. }
  460. void IF_swap(void)
  461. {
  462. struct Num *Elt, *Elt2;
  463. _VERIF_STACK_
  464. Elt = (struct Num *)StackN;
  465. if (Elt->n != VIDE) {
  466. _MODIF_STACKN_(Elt->n);
  467. Elt2 = (struct Num *)StackN;
  468. Elt->n = Elt2->n;
  469. Elt2->n = (void*)Elt;
  470. }
  471. else messErr(4);
  472. }
  473. void IF_over (void)
  474. {
  475. struct Num *Elt;
  476. _VERIF_STACK_
  477. Elt = (struct Num *)StackN;
  478. if (Elt->n != VIDE)
  479. dupElt((struct Num *)Elt->n);
  480. else messErr(4);
  481. }
  482. void IF_pick(void)
  483. {
  484. void * Next;
  485. struct Num * N;
  486. long n, i;
  487. _VERIF_STACK_
  488. if (!isScalar()) {
  489. messErr(36); return;
  490. }
  491. n = (long)getVal();
  492. dropElt();
  493. if (n>0) {
  494. Next = StackN;
  495. i=1;
  496. while (Next != VIDE) {
  497. if (i==n) break;
  498. N = (struct Num*) Next;
  499. Next = N->n;
  500. i++;
  501. }
  502. if (Next != VIDE) dupElt((struct Num *)Next);
  503. else messErr(4);
  504. } else messErr(29);
  505. }
  506. static int rotateBid(long n, int d) /* d=0 : rot d=1 : unrot */
  507. {
  508. void **ANext;
  509. struct Num * N, *N1;
  510. long i;
  511. ANext = _ADDR_STACKN_;
  512. i=1;
  513. while (*ANext != VIDE) {
  514. if (i==n) break;
  515. N = (struct Num*) *ANext;
  516. ANext = &N->n;
  517. i++;
  518. }
  519. if (*ANext != VIDE) {
  520. N = (struct Num*) *ANext;
  521. if (d) { /* unrot */
  522. N1 = (struct Num*) StackN;
  523. _MODIF_STACKN_(N1->n);
  524. N1->n = N->n;
  525. N->n = (void*)N1;
  526. } else { /* rot */
  527. *ANext = N->n;
  528. N->n = StackN;
  529. _MODIF_STACKN_((void*)N);
  530. }
  531. return 1;
  532. } else return 0;
  533. }
  534. void IF_rot(void)
  535. {
  536. if (!rotateBid(3L,0)) messErr(4);
  537. }
  538. void IF_unrot(void)
  539. {
  540. if (!rotateBid(3L,1)) messErr(4);
  541. }
  542. void IF_roll(void)
  543. {
  544. long n;
  545. _VERIF_STACK_
  546. if (!isScalar()) {
  547. messErr(36); return;
  548. }
  549. n = (long)getVal();
  550. dropElt();
  551. if (n>1) {
  552. if (!rotateBid(n,0)) messErr(4);
  553. } else messErr(30);
  554. }
  555. void IF_unroll(void)
  556. {
  557. long n;
  558. _VERIF_STACK_
  559. if (!isScalar()) {
  560. messErr(36); return;
  561. }
  562. n = (long)getVal();
  563. dropElt();
  564. if (n>1) {
  565. if (!rotateBid(n,1)) messErr(4);
  566. } else messErr(30);
  567. }
  568. void IF_depth(void)
  569. {
  570. void * Next;
  571. struct Num * N;
  572. long long i=0;
  573. Next = StackN;
  574. while (Next != VIDE) {
  575. N = (struct Num*) Next;
  576. i++;
  577. Next = N->n;
  578. }
  579. putLong(i);
  580. }
  581. int nbOnStack(void* A)
  582. {
  583. void * Next;
  584. struct Num * N;
  585. int i=0;
  586. Next = StackN;
  587. while (Next != VIDE) {
  588. N = (struct Num*) Next;
  589. if (Next == A) i++;
  590. Next = N->n;
  591. }
  592. return i;
  593. }
  594. static uint32_t nbSizeTypeOnStack(uint32_t n,uint32_t *T)
  595. {
  596. void * Next;
  597. struct Num * N;
  598. uint32_t i=0, D=0, S=0;
  599. Next = StackN;
  600. while (Next != VIDE) {
  601. N = (struct Num*) Next;
  602. S += N->t&MSK_T;
  603. if (N->t&MSK_R) D=1;
  604. Next = N->n;
  605. i++;
  606. if (i==n) break;
  607. }
  608. if (D) S = S|MSK_R;
  609. *T = S;
  610. return i;
  611. }
  612. void IF_Ndrop(void)
  613. {
  614. long n, i;
  615. _VERIF_STACK_
  616. if (!isScalar()) {
  617. messErr(36); return;
  618. }
  619. n = (long)getVal();
  620. dropElt();
  621. for(i=0;i<n;i++) if (!dropElt()) break;
  622. if (i<n) messErr(4); /* erreur pour la rigueur ! */
  623. }
  624. void IF_Ndup(void)
  625. {
  626. void *Next, *M, *NewS, **P;
  627. struct Num * Elt, * NElt;
  628. uint32_t n, i=0, t;
  629. int s;
  630. _VERIF_STACK_
  631. if (!isScalar()) {
  632. messErr(36); return;
  633. }
  634. n = (long)getVal();
  635. dropElt();
  636. if (n>0) {
  637. NewS=VIDE;
  638. P=&NewS;
  639. Next = StackN;
  640. while (Next != VIDE) {
  641. Elt = (struct Num*) Next;
  642. t = Elt->t&MSK_T;
  643. s = sizeof(struct Num)+((t-1)*(sizeof(double)));
  644. if ((M = malloc(s)) == NULL) stopErr("IF_Ndup","malloc");
  645. bcopy(Next,M,s);
  646. *P = M;
  647. NElt = (struct Num *)M;
  648. NElt->t = NElt->t & ~MSK_V; /* au cas ou Var */
  649. P=&NElt->n;
  650. i++;
  651. if (i==n) break;
  652. Next = Elt->n;
  653. }
  654. NElt->n = StackN;
  655. _MODIF_STACKN_(NewS);
  656. if (i<n) messErr(4); /* erreur pour la rigueur ! */
  657. } else messErr(29);
  658. }
  659. static void toDouble(struct Num * N)
  660. {
  661. uint32_t n;
  662. int i;
  663. double *d;
  664. long long *l;
  665. if (N->t & MSK_R) return;
  666. n = N->t&MSK_T;
  667. d = &N->d;
  668. l = &N->l;
  669. for(i=0; i<n; i++) *d++ = (double)*l++;
  670. N->t = N->t|MSK_R;
  671. }
  672. /* NET Functions for STSP */
  673. void IF_NetKey (void)
  674. {
  675. _VERIF_STACK_
  676. if (!isScalar()) {
  677. messErr(36); return;
  678. }
  679. _MODIF_NetKey_((uint32_t)getVal());
  680. dropElt();
  681. }
  682. void IF_NetErrVal (void)
  683. {
  684. putLong(-(long long)NetKey);
  685. }
  686. void StackToNet(long n)
  687. {
  688. struct Num *Elt;
  689. int i;
  690. uint32_t t, l;
  691. for (i=0; i<n ; i++) {
  692. if(StackN == VIDE) break;
  693. Elt = (struct Num *)StackN;
  694. t = Elt->t&MSK_T;
  695. l=(sizeof(struct Num)+((t-1)*(sizeof(double))));
  696. Elt->key = NetKey;
  697. sendDataC(StackN, l);
  698. dropElt();
  699. }
  700. }
  701. int NetDepth(uint32_t k)
  702. {
  703. void * Next;
  704. struct Num * N;
  705. int v=0;
  706. Next = StackN;
  707. while (Next != VIDE) {
  708. N = (struct Num*) Next;
  709. if (N->key == k) v++;
  710. Next = N->n;
  711. }
  712. return v;
  713. }
  714. void NetToStack(int s, uint32_t k)
  715. {
  716. void * Next;
  717. struct Num * N;
  718. uint32_t t, l;
  719. Next = StackN;
  720. while (Next != VIDE) {
  721. N = (struct Num*) Next;
  722. if (N->key == k) {
  723. t = N->t&MSK_T;
  724. l=(sizeof(struct Num)+((t-1)*(sizeof(double))));
  725. sendData(s, Next, l);
  726. }
  727. Next = N->n;
  728. }
  729. }
  730. void IF_show_netStack(uint32_t k)
  731. {
  732. void * Next;
  733. struct Num * N;
  734. Next = StackN;
  735. printf("<bottom of net stack>\n");
  736. while (Next != VIDE) {
  737. N = (struct Num*) Next;
  738. if (k == UNI_KEY) {
  739. printf("<0x%.8lx> ",(long)N->key);
  740. printElt(N,(long)-1);
  741. } else {
  742. if (N->key == k) printElt(N,(long)-1);
  743. }
  744. Next = N->n;
  745. }
  746. printf("<top of net stack> key=0x%lx\n",(long)k);
  747. }
  748. void IF_netDrop(uint32_t k)
  749. {
  750. void * Next, **ANext;
  751. struct Num * N;
  752. Next = StackN;
  753. ANext = _ADDR_STACKN_;
  754. while (Next != VIDE) {
  755. N = (struct Num*) Next;
  756. if (k == N->key) {
  757. *ANext = N->n;
  758. free(Next);
  759. Next = *ANext;
  760. continue;
  761. }
  762. Next = N->n;
  763. ANext = &(N->n);
  764. }
  765. }
  766. /* end of Net functions */
  767. static void IF_fct_2(char O)
  768. {
  769. struct Num *Elt, *Elt2;
  770. long long ConstL, *l1, *l2;
  771. double ConstD, *d1, *d2;
  772. int D1=0, D2=0, T1, T2, i;
  773. int M_C, M_D, M_S; /* Mode Const : 1 ou 0 | Double : 1 ou 0 | Swap : 1 ou 0 */
  774. bool B=TRUE;
  775. _VERIF_STACK_
  776. Elt = (struct Num *)StackN;
  777. T1 = Elt->t&MSK_T;
  778. D1 = Elt->t&MSK_R;
  779. if (Elt->n == VIDE) {
  780. messErr(4);
  781. return;
  782. }
  783. Elt2 = (struct Num *)Elt->n;
  784. T2 = Elt2->t&MSK_T;
  785. D2 = Elt2->t&MSK_R;
  786. /* si 2 tab de dim diff pas possible !! */
  787. if ((T1>1) && (T2>1) && (T1!=T2)) {
  788. messErr(3);
  789. return;
  790. }
  791. M_S = M_C = M_D = 0;
  792. if ((T1>1) && (T2==1)) { /* on swap */
  793. IF_swap();
  794. D1=D2=0;
  795. Elt = (struct Num *)StackN;
  796. T1 = Elt->t&MSK_T;
  797. D1 = Elt->t&MSK_R;
  798. Elt2 = (struct Num *)Elt->n;
  799. T2 = Elt2->t&MSK_T;
  800. D2 = Elt2->t&MSK_R;
  801. M_S=1;
  802. }
  803. if (D1!=D2) { /* on transforme long en double */
  804. if (D2) toDouble(Elt); else toDouble(Elt2);
  805. M_D = 1;
  806. } else if(D1) M_D = 1;
  807. l1 = &Elt->l;
  808. l2 = &Elt2->l;
  809. d1 = &Elt->d;
  810. d2 = &Elt2->d;
  811. if (T1==1) {
  812. M_C=1;
  813. if (M_D) ConstD = *d1;
  814. else ConstL = *l1;
  815. }
  816. /* pour debug
  817. printf("T1=%d T2=%d M_C=%d M_D=%d M_S=%d ",T1,T2,M_C,M_D,M_S);
  818. if (M_C)
  819. if (M_D) printf("ConstD=%g",ConstD); else printf("ConstL=%lld",ConstL);
  820. printf("\n");
  821. *****/
  822. switch(O) {
  823. case '+' :
  824. if (M_C) {
  825. if (M_D) for (i=0;i<T2;i++) *d2++ += ConstD;
  826. else for (i=0;i<T2;i++) *l2++ += ConstL;
  827. } else {
  828. if (M_D) for (i=0;i<T2;i++) *d2++ += *d1++;
  829. else for (i=0;i<T2;i++) *l2++ += *l1++;
  830. }
  831. break;
  832. case '-' :
  833. if (M_C) {
  834. if (M_S) {
  835. if (M_D) for (i=0;i<T2;i++) *d2++ = ConstD - *d2;
  836. else for (i=0;i<T2;i++) *l2++ = ConstL - *l2;
  837. } else {
  838. if (M_D) for (i=0;i<T2;i++) *d2++ -= ConstD;
  839. else for (i=0;i<T2;i++) *l2++ -= ConstL;
  840. }
  841. } else {
  842. if (M_D) for (i=0;i<T2;i++) *d2++ -= *d1++;
  843. else for (i=0;i<T2;i++) *l2++ -= *l1++;
  844. }
  845. break;
  846. case '*' :
  847. if (M_C) {
  848. if (M_D) for (i=0;i<T2;i++) *d2++ *= ConstD;
  849. else for (i=0;i<T2;i++) *l2++ *= ConstL;
  850. } else {
  851. if (M_D) for (i=0;i<T2;i++) *d2++ *= *d1++;
  852. else for (i=0;i<T2;i++) *l2++ *= *l1++;
  853. }
  854. break;
  855. case '/' :
  856. if (M_C) {
  857. if (M_S) {
  858. if (M_D) for (i=0;i<T2;i++) *d2++ = ConstD / *d2;
  859. else for (i=0;i<T2;i++) *l2++ = ConstL / *l2;
  860. } else {
  861. if (M_D) for (i=0;i<T2;i++) *d2++ /= ConstD;
  862. else for (i=0;i<T2;i++) *l2++ /= ConstL;
  863. }
  864. } else {
  865. if (M_D) for (i=0;i<T2;i++) *d2++ /= *d1++;
  866. else for (i=0;i<T2;i++) *l2++ /= *l1++;
  867. }
  868. break;
  869. case 'm' : /* min */
  870. if (M_C) {
  871. if (M_D) for(i=0;i<T2;i++) { if (*d2>ConstD) *d2=ConstD; d2++; }
  872. else for(i=0;i<T2;i++) { if (*l2>ConstL) *l2=ConstL; l2++; }
  873. } else {
  874. if (M_D) for (i=0;i<T2;i++) { if (*d2>*d1) *d2=*d1; d2++; d1++; }
  875. else for (i=0;i<T2;i++) { if (*l2>*l1) *l2=*l1; l2++; l1++; }
  876. }
  877. break;
  878. case 'M' : /* max */
  879. if (M_C) {
  880. if (M_D) for(i=0;i<T2;i++) { if (*d2<ConstD) *d2=ConstD; d2++; }
  881. else for(i=0;i<T2;i++) { if (*l2<ConstL) *l2=ConstL; l2++; }
  882. } else {
  883. if (M_D) for (i=0;i<T2;i++) { if (*d2<*d1) *d2=*d1; d2++; d1++; }
  884. else for (i=0;i<T2;i++) { if (*l2<*l1) *l2=*l1; l2++; l1++; }
  885. }
  886. break;
  887. case '%' : /* modulo */
  888. if (M_C) {
  889. if (M_S) {
  890. if (M_D) for (i=0;i<T2;i++) *d2++ = fmod(ConstD,*d2);
  891. else for (i=0;i<T2;i++) *l2++ = ConstL % *l2;
  892. } else {
  893. if (M_D) for (i=0;i<T2;i++) *d2++ = fmod(*d2,ConstD);
  894. else for (i=0;i<T2;i++) *l2++ %= ConstL;
  895. }
  896. } else {
  897. if (M_D) for (i=0;i<T2;i++) { *d2++ = fmod(*d2,*d1); d1++; }
  898. else for (i=0;i<T2;i++) *l2++ %= *l1++;
  899. }
  900. break;
  901. case '^' : /* puissance */
  902. if (! M_D) { /* passage en double force car + pratique */
  903. toDouble(Elt); toDouble(Elt2);
  904. if (M_C) ConstD=*d1;
  905. }
  906. if (M_C) {
  907. if (M_S) {
  908. for (i=0;i<T2;i++) *d2++ = pow(ConstD,*d2);
  909. } else {
  910. for (i=0;i<T2;i++) *d2++ = pow(*d2,ConstD);
  911. }
  912. } else {
  913. for (i=0;i<T2;i++) { *d2++ = pow(*d2,*d1); d1++; }
  914. }
  915. break;
  916. case '=' : /* test egal */
  917. if (M_C) {
  918. if (M_D) for(i=0;i<T2;i++) {
  919. if (*d2 != ConstD) {B=FALSE; break;} d2++; }
  920. else for (i=0;i<T2;i++) {
  921. if (*l2 != ConstL) {B=FALSE; break;} l2++; }
  922. } else {
  923. if (M_D) for (i=0;i<T2;i++) {
  924. if (*d2 != *d1) {B=FALSE; break;} d1++; d2++; }
  925. else for (i=0;i<T2;i++) {
  926. if (*l2 != *l1) {B=FALSE; break;} l1++; l2++; }
  927. }
  928. putBool(B);
  929. dropElt(); /* suppression des 2 !! */
  930. break;
  931. case '#' : /* test different */
  932. if (M_C) {
  933. if (M_D) for(i=0;i<T2;i++) {
  934. if (*d2 == ConstD) {B=FALSE; break;} d2++; }
  935. else for (i=0;i<T2;i++) {
  936. if (*l2 == ConstL) {B=FALSE; break;} l2++; }
  937. } else {
  938. if (M_D) for (i=0;i<T2;i++) {
  939. if (*d2 == *d1) {B=FALSE; break;} d1++; d2++; }
  940. else for (i=0;i<T2;i++) {
  941. if (*l2 == *l1) {B=FALSE; break;} l1++; l2++; }
  942. }
  943. putBool(B);
  944. dropElt(); /* suppression des 2 !! */
  945. break;
  946. case '<' : /* test inf */
  947. if (M_C) {
  948. if (M_S) {
  949. if (M_D) for(i=0;i<T2;i++) {
  950. if (*d2 < ConstD) {B=FALSE; break;} d2++; }
  951. else for (i=0;i<T2;i++) {
  952. if (*l2 < ConstL) {B=FALSE; break;} l2++; }
  953. } else {
  954. if (M_D) for(i=0;i<T2;i++) {
  955. if (*d2 >= ConstD) {B=FALSE; break;} d2++; }
  956. else for (i=0;i<T2;i++) {
  957. if (*l2 >= ConstL) {B=FALSE; break;} l2++; }
  958. }
  959. } else {
  960. if (M_D) for (i=0;i<T2;i++) {
  961. if (*d2 >= *d1) {B=FALSE; break;} d1++; d2++; }
  962. else for (i=0;i<T2;i++) {
  963. if (*l2 >= *l1) {B=FALSE; break;} l1++; l2++; }
  964. }
  965. putBool(B);
  966. dropElt(); /* suppression des 2 !! */
  967. break;
  968. case '>' : /* test sup */
  969. if (M_C) {
  970. if (M_S) {
  971. if (M_D) for(i=0;i<T2;i++) {
  972. if (*d2 > ConstD) {B=FALSE; break;} d2++; }
  973. else for (i=0;i<T2;i++) {
  974. if (*l2 > ConstL) {B=FALSE; break;} l2++; }
  975. } else {
  976. if (M_D) for(i=0;i<T2;i++) {
  977. if (*d2 <= ConstD) {B=FALSE; break;} d2++; }
  978. else for (i=0;i<T2;i++) {
  979. if (*l2 <= ConstL) {B=FALSE; break;} l2++; }
  980. }
  981. } else {
  982. if (M_D) for (i=0;i<T2;i++) {
  983. if (*d2 <= *d1) {B=FALSE; break;} d1++; d2++; }
  984. else for (i=0;i<T2;i++) {
  985. if (*l2 <= *l1) {B=FALSE; break;} l1++; l2++; }
  986. }
  987. putBool(B);
  988. dropElt(); /* suppression des 2 !! */
  989. break;
  990. case 'i' : /* test inf ou egal */
  991. if (M_C) {
  992. if (M_S) {
  993. if (M_D) for(i=0;i<T2;i++) {
  994. if (*d2 <= ConstD) {B=FALSE; break;} d2++; }
  995. else for (i=0;i<T2;i++) {
  996. if (*l2 <= ConstL) {B=FALSE; break;} l2++; }
  997. } else {
  998. if (M_D) for(i=0;i<T2;i++) {
  999. if (*d2 > ConstD) {B=FALSE; break;} d2++; }
  1000. else for (i=0;i<T2;i++) {
  1001. if (*l2 > ConstL) {B=FALSE; break;} l2++; }
  1002. }
  1003. } else {
  1004. if (M_D) for (i=0;i<T2;i++) {
  1005. if (*d2 > *d1) {B=FALSE; break;} d1++; d2++; }
  1006. else for (i=0;i<T2;i++) {
  1007. if (*l2 > *l1) {B=FALSE; break;} l1++; l2++; }
  1008. }
  1009. putBool(B);
  1010. dropElt(); /* suppression des 2 !! */
  1011. break;
  1012. case 's' : /* test sup ou egal */
  1013. if (M_C) {
  1014. if (M_S) {
  1015. if (M_D) for(i=0;i<T2;i++) {
  1016. if (*d2 >= ConstD) {B=FALSE; break;} d2++; }
  1017. else for (i=0;i<T2;i++) {
  1018. if (*l2 >= ConstL) {B=FALSE; break;} l2++; }
  1019. } else {
  1020. if (M_D) for(i=0;i<T2;i++) {
  1021. if (*d2 < ConstD) {B=FALSE; break;} d2++; }
  1022. else for (i=0;i<T2;i++) {
  1023. if (*l2 < ConstL) {B=FALSE; break;} l2++; }
  1024. }
  1025. } else {
  1026. if (M_D) for (i=0;i<T2;i++) {
  1027. if (*d2 < *d1) {B=FALSE; break;} d1++; d2++; }
  1028. else for (i=0;i<T2;i++) {
  1029. if (*l2 < *l1) {B=FALSE; break;} l1++; l2++; }
  1030. }
  1031. putBool(B);
  1032. dropElt(); /* suppression des 2 !! */
  1033. break;
  1034. default :
  1035. printf("%c : not yet implemented !\n",O);
  1036. break;
  1037. }
  1038. dropElt(); /* suppression du 1er */
  1039. }
  1040. void IF_plus(void) { IF_fct_2('+'); }
  1041. void IF_moins(void) { IF_fct_2('-'); }
  1042. void IF_mult(void) { IF_fct_2('*'); }
  1043. void IF_div(void) { IF_fct_2('/'); }
  1044. void IF_min(void) { IF_fct_2('m'); }
  1045. void IF_max(void) { IF_fct_2('M'); }
  1046. void IF_modulo(void) { IF_fct_2('%'); }
  1047. void IF_puiss(void) { IF_fct_2('^'); }
  1048. void IF_neg(void)
  1049. {
  1050. putLong((long long)-1);
  1051. IF_mult();
  1052. }
  1053. void IF_Legal(void) { IF_fct_2('='); }
  1054. void IF_Ldiff(void) { IF_fct_2('#'); }
  1055. void IF_Lsup(void) { IF_fct_2('>'); }
  1056. void IF_Linf(void) { IF_fct_2('<'); }
  1057. void IF_Lsupeg(void) { IF_fct_2('s'); }
  1058. void IF_Linfeg(void) { IF_fct_2('i'); }
  1059. void IF_fctD_1(double(*f)(double))
  1060. {
  1061. struct Num *Elt;
  1062. uint32_t n;
  1063. long long *L;
  1064. double *D;
  1065. int i;
  1066. _VERIF_STACK_
  1067. Elt = (struct Num *)StackN;
  1068. n = Elt->t&MSK_T;
  1069. if (Elt->t&MSK_R) { /* double */
  1070. D = &(Elt->d);
  1071. for(i=0;i<n;i++) *D++ = f(*D);
  1072. } else {
  1073. D = &(Elt->d);
  1074. L = &(Elt->l);
  1075. for(i=0;i<n;i++) *D++ = f((double)*L++);
  1076. Elt->t = Elt->t | MSK_R;
  1077. }
  1078. }
  1079. void IF_fctB_1(long long (*f1)(long long), double(*f2)(double))
  1080. {
  1081. struct Num *Elt;
  1082. uint32_t n;
  1083. long long *L;
  1084. double *D;
  1085. int i;
  1086. _VERIF_STACK_
  1087. Elt = (struct Num *)StackN;
  1088. n = Elt->t&MSK_T;
  1089. if (Elt->t&MSK_R) { /* double */
  1090. D = &(Elt->d);
  1091. for(i=0;i<n;i++) *D++ = f2(*D);
  1092. } else {
  1093. L = &(Elt->l);
  1094. for(i=0;i<n;i++) *L++ = f1(*L);
  1095. }
  1096. }
  1097. void IF_fctD_1L(long long(*f)(double))
  1098. {
  1099. struct Num *Elt;
  1100. uint32_t n;
  1101. long long *L;
  1102. double *D;
  1103. int i;
  1104. _VERIF_STACK_
  1105. Elt = (struct Num *)StackN;
  1106. n = Elt->t&MSK_T;
  1107. if (Elt->t&MSK_R) { /* double */
  1108. D = &(Elt->d);
  1109. L = &(Elt->l);
  1110. for(i=0;i<n;i++) *L++ = f(*D++);
  1111. Elt->t = Elt->t & ~MSK_R; /* change type */
  1112. }
  1113. /* rien si long */
  1114. }
  1115. void IF_fctD_1LB(long long(*f)(double))
  1116. {
  1117. struct Num *Elt;
  1118. uint32_t n;
  1119. long long *L;
  1120. double *D;
  1121. int i;
  1122. _VERIF_STACK_
  1123. Elt = (struct Num *)StackN;
  1124. n = Elt->t&MSK_T;
  1125. D = &(Elt->d);
  1126. L = &(Elt->l);
  1127. if (Elt->t&MSK_R) { /* double */
  1128. for(i=0;i<n;i++) *L++ = f(*D++);
  1129. Elt->t = Elt->t & ~MSK_R; /* change type */
  1130. } else {
  1131. for(i=0;i<n;i++) *L++ = f(*L);
  1132. }
  1133. }
  1134. void IF_inFile_1d(FILE * fd, char delim, int virg)
  1135. {
  1136. struct Num *Elt;
  1137. uint32_t n;
  1138. long long *L;
  1139. double *D;
  1140. int i;
  1141. char buf[40], *pt;
  1142. _VERIF_STACK_
  1143. Elt = (struct Num *)StackN;
  1144. n = Elt->t&MSK_T;
  1145. if (Elt->t&MSK_R) { /* double */
  1146. D = &(Elt->d);
  1147. for(i=0;i<n;i++) {
  1148. sprintf(buf,"%.15f%c",*D++,delim);
  1149. pt = buf + strlen(buf) - 2;
  1150. while (*pt == '0') pt--;
  1151. pt++;
  1152. *pt++ = delim;
  1153. *pt='\0';
  1154. if (virg)
  1155. if ((pt = strchr(buf, (int)'.')) != NULL) *pt = ',';
  1156. fprintf(fd,buf);
  1157. }
  1158. } else {
  1159. L = &(Elt->l);
  1160. for(i=0;i<n;i++) fprintf(fd,"%lld%c",*L++,delim);
  1161. }
  1162. fprintf(fd,"\n");
  1163. dropElt(); /* suppression */
  1164. }
  1165. void IF_inFile_1(FILE * fd)
  1166. {
  1167. struct Num *Elt;
  1168. uint32_t n;
  1169. long long *L;
  1170. double *D;
  1171. int i;
  1172. _VERIF_STACK_
  1173. Elt = (struct Num *)StackN;
  1174. n = Elt->t&MSK_T;
  1175. if (Elt->t&MSK_R) { /* double */
  1176. D = &(Elt->d);
  1177. for(i=0;i<n;i++) fprintf(fd,"%d %g\n",i,*D++);
  1178. } else {
  1179. L = &(Elt->l);
  1180. for(i=0;i<n;i++) fprintf(fd,"%d %lld\n",i,*L++);
  1181. }
  1182. }
  1183. void IF_inFile_2(FILE * fd)
  1184. {
  1185. struct Num *Elt, *Elt2;
  1186. uint32_t n, n2;
  1187. long long *L, *L2;
  1188. double *D, *D2;
  1189. int i;
  1190. _VERIF_STACK_
  1191. Elt = (struct Num *)StackN;
  1192. n = Elt->t&MSK_T;
  1193. Elt2 = Elt->n;
  1194. n2 = Elt2->t&MSK_T;
  1195. if (n>n2) n=n2;
  1196. if (Elt->t&MSK_R) { /* double */
  1197. D = &(Elt->d);
  1198. if (Elt2->t&MSK_R) { /* double */
  1199. D2 = &(Elt2->d);
  1200. for(i=0;i<n;i++) fprintf(fd,"%g %g\n",*D2++,*D++);
  1201. } else {
  1202. L2 = &(Elt2->l);
  1203. for(i=0;i<n;i++) fprintf(fd,"%lld %g\n",*L2++,*D++);
  1204. }
  1205. } else {
  1206. L = &(Elt->l);
  1207. if (Elt2->t&MSK_R) { /* double */
  1208. D2 = &(Elt2->d);
  1209. for(i=0;i<n;i++) fprintf(fd,"%g %lld\n",*D2++,*L++);
  1210. } else {
  1211. L2 = &(Elt2->l);
  1212. for(i=0;i<n;i++) fprintf(fd,"%lld %lld\n",*L2++,*L++);
  1213. }
  1214. }
  1215. }
  1216. static int dimTab(void * A)
  1217. {
  1218. struct Num *N;
  1219. uint32_t l;
  1220. if (A==VIDE) return 0L;
  1221. N = (struct Num*)A;
  1222. l = N->t&MSK_T;
  1223. return (int)l;
  1224. }
  1225. static long transLongTo(long long * C)
  1226. {
  1227. struct Num *Elt;
  1228. int i;
  1229. uint32_t l;
  1230. long long *L;
  1231. double *D;
  1232. Elt = (struct Num *)StackN;
  1233. l = Elt->t&MSK_T;
  1234. L = &(Elt->l)+l-1;
  1235. D = &(Elt->d)+l-1;
  1236. if (Elt->t & MSK_R)
  1237. for (i=0;i<l;i++) *C--=(long long)*D--;
  1238. else
  1239. for (i=0;i<l;i++) *C--=*L--;
  1240. dropElt();
  1241. return(l);
  1242. }
  1243. static long transDoubTo(double * C)
  1244. {
  1245. struct Num *Elt;
  1246. int i;
  1247. uint32_t l;
  1248. long long *L;
  1249. double *D;
  1250. Elt = (struct Num *)StackN;
  1251. l = Elt->t&MSK_T;
  1252. L = &(Elt->l)+l-1;
  1253. D = &(Elt->d)+l-1;
  1254. if (Elt->t & MSK_R)
  1255. for (i=0;i<l;i++) *C--=*D--;
  1256. else
  1257. for (i=0;i<l;i++) *C--=(double)*L--;
  1258. dropElt();
  1259. return(l);
  1260. }
  1261. void IF_toArray( void )
  1262. {
  1263. uint32_t n, i, l, T, t;
  1264. long long *L;
  1265. double *D;
  1266. void * M;
  1267. struct Num *N;
  1268. _VERIF_STACK_
  1269. if (!isScalar()) {
  1270. messErr(36); return;
  1271. }
  1272. n = (uint32_t)getVal();
  1273. dropElt();
  1274. if (n>1) {
  1275. i = nbSizeTypeOnStack(n,&t);
  1276. if (i<n) messErr(4);
  1277. else {
  1278. T = t & MSK_T;
  1279. if ((M = malloc(sizeof(struct Num)+((T-1)*(sizeof(double))))) == NULL)
  1280. stopErr("IF_toArray","malloc");
  1281. N = (struct Num*)M;
  1282. N->t = t;
  1283. if (t & MSK_R) {
  1284. D = &(N->d)+(T-1);
  1285. for(i=0;i<n;i++) { l=transDoubTo(D); D -= l; }
  1286. } else {
  1287. L = &(N->l)+(T-1);
  1288. for(i=0;i<n;i++) { l=transLongTo(L); L -= l; }
  1289. }
  1290. /* on the stack */
  1291. N->n = StackN;
  1292. _MODIF_STACKN_(M);
  1293. }
  1294. } else messErr(30);
  1295. }
  1296. static void toScalar( int s )
  1297. {
  1298. struct Num *Elt;
  1299. uint32_t l;
  1300. int i;
  1301. double *D;
  1302. long long * L;
  1303. _VERIF_STACK_
  1304. Elt = (struct Num *)StackN;
  1305. l = Elt->t&MSK_T;
  1306. if (l==1) return;
  1307. _MODIF_STACKN_(Elt->n); /* depile */
  1308. if (s) {
  1309. L = &(Elt->l);
  1310. D = &(Elt->d);
  1311. if (Elt->t & MSK_R)
  1312. for(i=0;i<l;i++) putDouble(*D++);
  1313. else
  1314. for(i=0;i<l;i++) putLong(*L++);
  1315. } else {
  1316. L = &(Elt->l)+l-1;
  1317. D = &(Elt->d)+l-1;
  1318. if (Elt->t & MSK_R)
  1319. for(i=0;i<l;i++) putDouble(*D--);
  1320. else
  1321. for(i=0;i<l;i++) putLong(*L--);
  1322. }
  1323. if (!(Elt->t&MSK_V)) free((void*)Elt);
  1324. }
  1325. void IF_toScalar( void )
  1326. {
  1327. toScalar(1);
  1328. }
  1329. void IF_toScalarR( void )
  1330. {
  1331. toScalar(0);
  1332. }
  1333. static void tabShift(void **A,long s)
  1334. {
  1335. struct Num *Elt, *NElt;
  1336. void * M;
  1337. long j, k;
  1338. uint32_t l;
  1339. long long *L, *NL;
  1340. _VERIF_STACK_
  1341. Elt = (struct Num *)*A;
  1342. l = Elt->t&MSK_T;
  1343. if (l==1) return;
  1344. if (s>0)
  1345. while (s>=l) s-=l;
  1346. else while (-s>=l) s+=l;
  1347. if (s==0) return;
  1348. if (s>0) j=s;
  1349. else j=l+s;
  1350. k = sizeof(struct Num)+((l-1)*(sizeof(double)));
  1351. if ((M = malloc(k)) == NULL) stopErr("tabShift","malloc");
  1352. NElt = (struct Num *)M;
  1353. *A = M;
  1354. NElt->t = Elt->t;
  1355. NElt->n = Elt->n;
  1356. L = &(Elt->l);
  1357. NL = &(NElt->l);
  1358. k=l-j;
  1359. bcopy((void*)&L[0],(void*)&NL[j],k*sizeof(long long));
  1360. bcopy((void*)&L[k],(void*)&NL[0],j*sizeof(long long));
  1361. if (!(Elt->t&MSK_V)) free((void*)Elt);
  1362. }
  1363. void IF_TShiftR( void )
  1364. {
  1365. tabShift(_ADDR_STACKN_,1);
  1366. }
  1367. void IF_TShiftL( void )
  1368. {
  1369. tabShift(_ADDR_STACKN_,-1);
  1370. }
  1371. static void nTabShift( int v )
  1372. {
  1373. void ** ANext;
  1374. struct Num * N;
  1375. long i=0, n;
  1376. _VERIF_STACK_
  1377. if (!isScalar()) {
  1378. messErr(36); return;
  1379. }
  1380. n = (long)getVal();
  1381. dropElt();
  1382. if (n>0) {
  1383. ANext = _ADDR_STACKN_;
  1384. while (*ANext != VIDE) {
  1385. tabShift(ANext,v);
  1386. N = (struct Num*) *ANext;
  1387. ANext = &(N->n);
  1388. i++;
  1389. if (i==n) break;
  1390. }
  1391. } else messErr(29);
  1392. }
  1393. void IF_NTShiftR( void )
  1394. {
  1395. nTabShift(1);
  1396. }
  1397. void IF_NTShiftL( void )
  1398. {
  1399. nTabShift(-1);
  1400. }
  1401. void IF_TNShiftR( void )
  1402. {
  1403. long n;
  1404. _VERIF_STACK_
  1405. if (!isScalar()) {
  1406. messErr(36); return;
  1407. }
  1408. n = (long)getVal();
  1409. dropElt();
  1410. tabShift(_ADDR_STACKN_,n);
  1411. }
  1412. void IF_TNShiftL( void )
  1413. {
  1414. long n;
  1415. _VERIF_STACK_
  1416. if (!isScalar()) {
  1417. messErr(36); return;
  1418. }
  1419. n = (long)getVal();
  1420. dropElt();
  1421. tabShift(_ADDR_STACKN_,-n);
  1422. }
  1423. static void nTNShift( int s )
  1424. {
  1425. long n;
  1426. _VERIF_STACK_
  1427. if (!isScalar()) {
  1428. messErr(36); return;
  1429. }
  1430. n = (long)getVal();
  1431. dropElt();
  1432. nTabShift(n*s);
  1433. }
  1434. void IF_NTNShiftR( void )
  1435. {
  1436. nTNShift(1);
  1437. }
  1438. void IF_NTNShiftL( void )
  1439. {
  1440. nTNShift(-1);
  1441. }
  1442. static void subTab(void **pA , long n, char r) /* r=1 : right else left */
  1443. {
  1444. struct Num *Elt, *Elt2;
  1445. uint32_t l;
  1446. long k;
  1447. long long *L, *Lf;
  1448. void *A, * M;
  1449. double *D, *Df;
  1450. _VERIF_STACK_
  1451. A = *pA;
  1452. Elt = (struct Num *)A;
  1453. l = Elt->t&MSK_T;
  1454. if (l==n) return;
  1455. k = sizeof(struct Num)+((n-1)*(sizeof(long long)));
  1456. if ((M = malloc(k)) == NULL) stopErr("subTab","malloc");
  1457. Elt2 = (struct Num *)M;
  1458. Elt2->n = Elt->n;
  1459. Elt2->t = (Elt->t&MSK_R) | n;
  1460. *pA = M;
  1461. if (n<l) {
  1462. L = &(Elt->l);
  1463. if (r) L += (l-n);
  1464. bcopy((void*)L,(void*)&(Elt2->l),n*sizeof(long long));
  1465. } else { /* fill with zero */
  1466. L = &(Elt2->l);
  1467. if (!r) L += (n-l);
  1468. bcopy((void*)&(Elt->l),(void*)L,l*sizeof(long long));
  1469. if (Elt->t&MSK_R) {
  1470. D = &(Elt2->d);
  1471. if (r) D += l;
  1472. Df = D + (n-l);
  1473. while (D < Df) *D++ = (double)0;
  1474. } else {
  1475. L = &(Elt2->l);
  1476. if (r) L += l;
  1477. Lf = L + (n-l);
  1478. while (L < Lf) *L++ = 0L;
  1479. }
  1480. }
  1481. if (!(Elt->t&MSK_V)) free(A);
  1482. }
  1483. void IF_subTab(void)
  1484. {
  1485. long n;
  1486. _VERIF_STACK_
  1487. if (!isScalar()) {
  1488. messErr(36); return;
  1489. }
  1490. n = (long)getVal();
  1491. dropElt();
  1492. if (n>0) subTab(_ADDR_STACKN_, n, 0);
  1493. else messErr(29);
  1494. }
  1495. void IF_subTabR(void)
  1496. {
  1497. long n;
  1498. _VERIF_STACK_
  1499. if (!isScalar()) {
  1500. messErr(36); return;
  1501. }
  1502. n = (long)getVal();
  1503. dropElt();
  1504. if (n>0) subTab(_ADDR_STACKN_, n, (char)1);
  1505. else messErr(29);
  1506. }
  1507. static void NSubTab( char r )
  1508. {
  1509. void **pNext;
  1510. struct Num * N;
  1511. long i=0, n, l;
  1512. _VERIF_STACK_
  1513. if (!isScalar()) {
  1514. messErr(36); return;
  1515. }
  1516. l = (long)getVal();
  1517. dropElt();
  1518. if (l>0) {
  1519. if (!isScalar()) {
  1520. messErr(36); return;
  1521. }
  1522. n = (long)getVal();
  1523. dropElt();
  1524. if (n>0) {
  1525. pNext = _ADDR_STACKN_;
  1526. while (*pNext != VIDE) {
  1527. subTab(pNext,l,r);
  1528. N = (struct Num*) *pNext;
  1529. pNext = &(N->n);
  1530. i++;
  1531. if (i==n) break;
  1532. }
  1533. } else messErr(29);
  1534. } else messErr(29);
  1535. }
  1536. void IF_NsubTab(void)
  1537. {
  1538. NSubTab((char)0);
  1539. }
  1540. void IF_NsubTabR(void)
  1541. {
  1542. NSubTab((char)1);
  1543. }
  1544. static void tabRev( void* A )
  1545. {
  1546. struct Num *Elt;
  1547. uint32_t l;
  1548. double *D, *FD, vD;
  1549. long long * L, *FL, vL;
  1550. _VERIF_STACK_
  1551. Elt = (struct Num *)A;
  1552. l = Elt->t&MSK_T;
  1553. if (l==1) return;
  1554. if (Elt->t & MSK_R) {
  1555. D = &(Elt->d);
  1556. FD = D+l-1;
  1557. while (D<FD) {
  1558. vD=*D; *D=*FD; *FD=vD;
  1559. D++; FD--;
  1560. }
  1561. } else {
  1562. L = &(Elt->l);
  1563. FL=L+l-1;
  1564. while (L<FL) {
  1565. vL=*L; *L=*FL; *FL=vL;
  1566. L++; FL--;
  1567. }
  1568. }
  1569. }
  1570. void IF_TabRev( void )
  1571. {
  1572. tabRev(StackN);
  1573. }
  1574. void IF_NTabRev( void )
  1575. {
  1576. void * Next;
  1577. struct Num * N;
  1578. long i=0, n;
  1579. _VERIF_STACK_
  1580. if (!isScalar()) {
  1581. messErr(36); return;
  1582. }
  1583. n = (long)getVal();
  1584. dropElt();
  1585. if (n>0) {
  1586. Next = StackN;
  1587. while (Next != VIDE) {
  1588. N = (struct Num*) Next;
  1589. tabRev(Next);
  1590. Next = N->n;
  1591. i++;
  1592. if (i==n) break;
  1593. }
  1594. } else messErr(29);
  1595. }
  1596. static void tabTransp (int sens)
  1597. {
  1598. void * Next, *Next2, **Suiv, *SNext, **Last;
  1599. struct Num * N, *N2;
  1600. long i=0, j, n;
  1601. uint32_t l;
  1602. short Doub=0;
  1603. double *D, *D2;
  1604. long long *L, *L2;
  1605. _VERIF_STACK_
  1606. if (!isScalar()) {
  1607. messErr(36); return;
  1608. }
  1609. n = (long)getVal();
  1610. dropElt();
  1611. if (n>0) {
  1612. if (n==1) {
  1613. if (sens) toScalar(1);
  1614. else toScalar(0);
  1615. return;
  1616. }
  1617. /* the n elts on stack must have the same dim */
  1618. Next = StackN;
  1619. while (Next != VIDE) {
  1620. N = (struct Num*) Next;
  1621. if (i) {
  1622. if (l != (N->t&MSK_T)) break;
  1623. } else l = N->t&MSK_T;
  1624. if (N->t&MSK_R) Doub=1;
  1625. i++;
  1626. if (i==n) break;
  1627. Next = N->n;
  1628. }
  1629. if (i!=n) {
  1630. if (Next == VIDE) messErr(4);
  1631. else messErr(3);
  1632. } else {
  1633. /* make l elts of dim n */
  1634. Suiv = &Next2;
  1635. for (i=0;i<l;i++) {
  1636. if ((*Suiv=malloc(sizeof(struct Num)+((n-1)*(sizeof(double)))))==NULL)
  1637. stopErr("tabTransp","malloc");
  1638. N2 = (struct Num*) *Suiv;
  1639. N2->t = n;
  1640. if (Doub) N2->t |= MSK_R;
  1641. /* remplissage */
  1642. if (sens) {
  1643. j=0;
  1644. if (sens==1) {
  1645. N2->n = SNext;
  1646. SNext = Next2;
  1647. if (i==0) Last = &(N2->n);
  1648. } else
  1649. Suiv = &N2->n;
  1650. } else {
  1651. j=n-1;
  1652. Suiv = &N2->n;
  1653. }
  1654. if (Doub) {
  1655. D2 = &(N2->d);
  1656. } else {
  1657. L2 = &(N2->l);
  1658. }
  1659. Next = StackN;
  1660. while (Next != VIDE) {
  1661. N = (struct Num*) Next;
  1662. if (Doub) {
  1663. if (N->t&MSK_R) {
  1664. D = &(N->d);
  1665. if (sens) D+=(l-i-1);
  1666. else D+=i;
  1667. *(D2+j) = *D;
  1668. } else {
  1669. L = &(N->l);
  1670. if (sens) L+=(l-i-1);
  1671. else L+=i;
  1672. *(D2+j) = (double)*L;
  1673. }
  1674. } else {
  1675. L = &(N->l);
  1676. if (sens) L+=(l-i-1);
  1677. else L+=i;
  1678. *(L2+j) = *L;
  1679. /* printf("%ld ",*L); */
  1680. }
  1681. if (sens) {
  1682. j++;
  1683. if (j>=n) break;
  1684. } else {
  1685. j--;
  1686. if (j<0) break;
  1687. }
  1688. Next = N->n;
  1689. }
  1690. /* printf("\n"); */
  1691. }
  1692. if (sens!=1) Last = &(N2->n);
  1693. /* drop n elts */
  1694. for (i=0;i<n;i++) dropElt();
  1695. /* put new elts on the stack */
  1696. *Last = StackN;
  1697. _MODIF_STACKN_(Next2);
  1698. }
  1699. } else messErr(29);
  1700. }
  1701. void IF_TabTransp (void) /* crot */
  1702. {
  1703. tabTransp(0);
  1704. }
  1705. void IF_TabTranspN (void) /* transpose */
  1706. {
  1707. tabTransp(1);
  1708. }
  1709. void IF_TabTranspT (void) /* trot */
  1710. {
  1711. tabTransp(-1);
  1712. }
  1713. int is1Tab(void)
  1714. {
  1715. if (dimTab(StackN) < 2L) return 0;
  1716. return 1;
  1717. }
  1718. int is2Tab(void)
  1719. {
  1720. struct Num *N;
  1721. if (dimTab(StackN) < 2L) return 0;
  1722. N = (struct Num*)StackN;
  1723. if (dimTab(N->n) < 2L) return 0;
  1724. return 1;
  1725. }
  1726. int isNTabSameDim(int n)
  1727. {
  1728. void * Next;
  1729. struct Num * N;
  1730. long i=0;
  1731. uint32_t l;
  1732. /* the n elts on stack must have the same dim */
  1733. Next = StackN;
  1734. while (Next != VIDE) {
  1735. N = (struct Num*) Next;
  1736. if (i) {
  1737. if (l != (long)(N->t&MSK_T)) break;
  1738. } else l = N->t&MSK_T;
  1739. i++;
  1740. if (i==n) return 1; /* OK */
  1741. Next = N->n;
  1742. }
  1743. return 0;
  1744. }
  1745. /* []functions ****/
  1746. static void TAB_Fct(char C)
  1747. {
  1748. struct Num *Elt;
  1749. uint32_t n;
  1750. long long *L, L1, L2;
  1751. double *D, D1, D2;
  1752. int i;
  1753. _VERIF_STACK_
  1754. Elt = (struct Num *)StackN;
  1755. n = Elt->t&MSK_T;
  1756. if (n>1) {
  1757. if (Elt->t&MSK_R) { /* double */
  1758. switch(C) {
  1759. case 'm' :
  1760. D1 = Elt->d;
  1761. D = &(Elt->d)+1;
  1762. for(i=1;i<n;i++) { if (*D<D1) D1=*D; D++; }
  1763. putDouble(D1);
  1764. break;
  1765. case 'M' :
  1766. D1 = Elt->d;
  1767. D = &(Elt->d)+1;
  1768. for(i=1;i<n;i++) { if (*D>D1) D1=*D; D++; }
  1769. putDouble(D1);
  1770. break;
  1771. case '+' :
  1772. D1 = Elt->d;
  1773. D = &(Elt->d)+1;
  1774. for(i=1;i<n;i++) D1 += *D++;
  1775. putDouble(D1);
  1776. break;
  1777. case '*' :
  1778. D1 = Elt->d;
  1779. D = &(Elt->d)+1;
  1780. for(i=1;i<n;i++) D1 *= *D++;
  1781. putDouble(D1);
  1782. break;
  1783. default : /* E = extrems */
  1784. D1 = D2 = Elt->d;
  1785. D = &(Elt->d)+1;
  1786. for(i=1;i<n;i++) {
  1787. if (*D>D2) D2=*D;
  1788. if (*D<D1) D1=*D; D++;
  1789. }
  1790. putDouble(D1);
  1791. IF_swap();
  1792. putDouble(D2);
  1793. break;
  1794. }
  1795. } else {
  1796. switch(C) {
  1797. case 'm' :
  1798. L1 = Elt->l;
  1799. L = &(Elt->l)+1;
  1800. for(i=1;i<n;i++) { if (*L<L1) L1=*L; L++; }
  1801. putLong(L1);
  1802. break;
  1803. case 'M' :
  1804. L1 = Elt->l;
  1805. L = &(Elt->l)+1;
  1806. for(i=1;i<n;i++) { if (*L>L1) L1=*L; L++; }
  1807. putLong(L1);
  1808. break;
  1809. case '+' :
  1810. L1 = Elt->l;
  1811. L = &(Elt->l)+1;
  1812. for(i=1;i<n;i++) L1 += *L++;
  1813. putLong(L1);
  1814. break;
  1815. case '*' :
  1816. L1 = Elt->l;
  1817. L = &(Elt->l)+1;
  1818. for(i=1;i<n;i++) L1 *= *L++;
  1819. putLong(L1);
  1820. break;
  1821. default : /* E = extrems */
  1822. L1 = L2 = Elt->l;
  1823. L = &(Elt->l)+1;
  1824. for(i=1;i<n;i++) {
  1825. if (*L>L2) L2=*L;
  1826. if (*L<L1) L1=*L; L++;
  1827. }
  1828. putLong(L1);
  1829. IF_swap();
  1830. putLong(L2);
  1831. break;
  1832. }
  1833. }
  1834. IF_swap();
  1835. dropElt();
  1836. } else messErr(12);
  1837. }
  1838. void IF_TABMin(void) { TAB_Fct('m'); }
  1839. void IF_TABMax(void) { TAB_Fct('M'); }
  1840. void IF_TABProd(void) { TAB_Fct('*'); }
  1841. void IF_TABSum(void) { TAB_Fct('+'); }
  1842. void IF_TABMinMax(void) { TAB_Fct('E'); }
  1843. #define LENT 20
  1844. void dump_eltN(int fd, void *A, uint32_t MSK)
  1845. {
  1846. struct Num * N;
  1847. long l;
  1848. long long v;
  1849. uint32_t t;
  1850. N = (struct Num*)A;
  1851. t = N->t;
  1852. if ((MSK) && (t & MSK_V)) {
  1853. v = (long long)iVarByAddrA(A);
  1854. t = 1 | MSK_V;
  1855. write(fd, (void*)&t, sizeof(t));
  1856. write(fd, (void*)&v, sizeof(v));
  1857. } else {
  1858. /* t &= ~MSK_V; */
  1859. write(fd, (void*)&t, sizeof(t));
  1860. l = t & MSK_T;
  1861. write(fd, (void*)&(N->l), (size_t)(l*sizeof(double)));
  1862. }
  1863. }
  1864. static int NbARIV;
  1865. void restore_links_stackN(void)
  1866. {
  1867. void **ANext, *A;
  1868. struct Num * N, *T;
  1869. if (NbARIV == 0) return;
  1870. ANext = &StackN;
  1871. while (*ANext != VIDE) {
  1872. N = (struct Num*) *ANext;
  1873. if (N->t & MSK_V) {
  1874. A = varAddrAByInd(N->l);
  1875. T = (struct Num*) A;
  1876. T->n = N->n;
  1877. *ANext = A;
  1878. free((void*)N);
  1879. }
  1880. ANext = &(N->n);
  1881. }
  1882. rest_links_pr(NbARIV, "variable", "numerical");
  1883. }
  1884. void dump_stackN(int fd)
  1885. {
  1886. void * Next;
  1887. struct Num * N;
  1888. uint32_t n=0;
  1889. int i,j;
  1890. Next = StackN;
  1891. while (Next != VIDE) {
  1892. N = (struct Num*) Next;
  1893. n++;
  1894. Next = N->n;
  1895. }
  1896. write(fd, (void*)&n, sizeof(n));
  1897. for (i=n; i>0; i--) {
  1898. Next = StackN;
  1899. j=0;
  1900. while (Next != VIDE) {
  1901. N = (struct Num*) Next;
  1902. j++;
  1903. if (i==j) break;
  1904. Next = N->n;
  1905. }
  1906. dump_eltN(fd, Next, MSK_V);
  1907. }
  1908. dump_rest_pr(0,n,"numerical");
  1909. }
  1910. static void * restore_eltN_l(int fd, int K)
  1911. {
  1912. uint32_t t, u;
  1913. int s;
  1914. void * M;
  1915. struct Num * N;
  1916. read(fd, (void*)&t, sizeof(t));
  1917. u = t & MSK_T;
  1918. if ((t & MSK_V) && K) NbARIV++;
  1919. /* printf("%u : %d\n", u, NbARIV); /* debug */
  1920. s = sizeof(struct Num)+((u-1)*(sizeof(double)));
  1921. if ((M = malloc(s)) == NULL) stopErr("restore_eltN","malloc");
  1922. N = (struct Num*)M;
  1923. N->t = t;
  1924. N->n = StackN;
  1925. read(fd, (void*)&(N->l), u*sizeof(double));
  1926. return M;
  1927. }
  1928. void * restore_eltN(int fd)
  1929. {
  1930. return restore_eltN_l(fd,0);
  1931. }
  1932. void restore_stackN(int fd)
  1933. {
  1934. uint32_t n=0, i;
  1935. void * M;
  1936. NbARIV = 0;
  1937. if (read(fd, (void*)&n, sizeof(n)) != sizeof(n)) return;
  1938. IF_stack_clear();
  1939. for (i=0; i<n; i++) {
  1940. M = restore_eltN_l(fd,1);
  1941. _MODIF_STACKN_(M);
  1942. }
  1943. dump_rest_pr(1,n,"numerical");
  1944. }