#include "ros2_inc.mm" Func void printmat(name, m) String name; Matrix m; { Integer k, j; Integer row, col; {row, col}= size(m); printf("# %s (%d x %d) ------------ \n",name, row, col); for(k=1; k<=row; k++){ printf("# "); for(j=1; j<=col; j++){ printf("%g ",m(k,j)); } printf("\n"); } printf("# -------------------\n"); } Func void rem_prm_output(){ printf("# PI = %g\n",PI); printf("# PID = %d\n",PID); printf("# EPS = %g\n",EPS); printf("# Inf = %g\n",Inf); printf("# NaN = %g\n",NaN); printf("# c = %g\n",c); printf("# b = %g\n",b); printf("# a = %g\n",a); printf("# t_fin = %g\n",t_fin); printf("# h = %g\n",h); printf("# pid = %d\n",pid); printf("# update_interval = %d\n",update_interval); printf("# auto_clear = %d\n",auto_clear); }