/* * Retrieve the current rt_dptbl from memory, convert the time quantum * values to the resolution specified by res and write the table to stdout. */ static void get_rtdptbl(ulong_t res) { int i; int rtdpsz; pcinfo_t pcinfo; pcadmin_t pcadmin; rtadmin_t rtadmin; rtdpent_t *rt_dptbl; hrtimer_t hrtime; (void) strcpy(pcinfo.pc_clname, "RT"); if (priocntl(0, 0, PC_GETCID, (caddr_t)&pcinfo) == -1) fatalerr("%s: Can't get RT class ID, priocntl system call " "failed with errno %d\n", basenm, errno); pcadmin.pc_cid = pcinfo.pc_cid; pcadmin.pc_cladmin = (char *)&rtadmin; rtadmin.rt_cmd = RT_GETDPSIZE; if (priocntl(0, 0, PC_ADMIN, (caddr_t)&pcadmin) == -1) fatalerr("%s: Can't get rt_dptbl size, priocntl system call " "failed with errno %d\n", basenm, errno); rtdpsz = rtadmin.rt_ndpents * sizeof (rtdpent_t); if ((rt_dptbl = (rtdpent_t *)malloc(rtdpsz)) == NULL) fatalerr("%s: Can't allocate memory for rt_dptbl\n", basenm); rtadmin.rt_dpents = rt_dptbl; rtadmin.rt_cmd = RT_GETDPTBL; if (priocntl(0, 0, PC_ADMIN, (caddr_t)&pcadmin) == -1) fatalerr("%s: Can't get rt_dptbl, priocntl system call " "failed with errno %d\n", basenm, errno); (void) printf("# Real Time Dispatcher Configuration\n"); (void) printf("RES=%ld\n\n", res); (void) printf("# TIME QUANTUM PRIORITY\n"); (void) printf("# (rt_quantum) LEVEL\n"); for (i = 0; i < rtadmin.rt_ndpents; i++) { if (res != HZ && rt_dptbl[i].rt_quantum != RT_TQINF) { hrtime.hrt_secs = 0; hrtime.hrt_rem = rt_dptbl[i].rt_quantum; hrtime.hrt_res = HZ; if (_hrtnewres(&hrtime, res, HRT_RNDUP) == -1) fatalerr("%s: Can't convert to requested " "resolution\n", basenm); if ((rt_dptbl[i].rt_quantum = hrtconvert(&hrtime)) == -1) fatalerr("%s: Can't express time quantum in " "requested resolution,\n" "try coarser resolution\n", basenm); } (void) printf("%10d # %3d\n", rt_dptbl[i].rt_quantum, i); } }
/* * Execute the command pointed to by cmdargv as a real-time process * with real time priority rtpri, quantum tqntm/res and quantum signal rtqsig. */ static void exec_rtcmd(char **cmdargv, uint_t cflags, pri_t rtpri, long tqntm, long res, int rtqsig) { pcinfo_t pcinfo; uintptr_t args[2*RT_KEYCNT+1]; uintptr_t *argsp = &args[0]; pri_t maxrtpri; hrtimer_t hrtime; /* * Get the real time class ID and max configured RT priority. */ (void) strcpy(pcinfo.pc_clname, "RT"); if (priocntl(0, 0, PC_GETCID, (caddr_t)&pcinfo) == -1) fatalerr("%s: Can't get RT class ID, priocntl system call" " failed with errno %d\n", basenm, errno); maxrtpri = ((rtinfo_t *)pcinfo.pc_clinfo)->rt_maxpri; if ((cflags & RT_DOPRI) != 0) { if (rtpri > maxrtpri || rtpri < 0) fatalerr("%s: Specified real time priority %d out of" " configured range\n", basenm, rtpri); ADDKEYVAL(argsp, RT_KY_PRI, rtpri); } if ((cflags & RT_DOTQ) != 0) { hrtime.hrt_secs = 0; hrtime.hrt_rem = tqntm; hrtime.hrt_res = res; if (_hrtnewres(&hrtime, NANOSEC, HRT_RNDUP) == -1) fatalerr("%s: Can't convert resolution.\n", basenm); ADDKEYVAL(argsp, RT_KY_TQSECS, hrtime.hrt_secs); ADDKEYVAL(argsp, RT_KY_TQNSECS, hrtime.hrt_rem); } if ((cflags & RT_DOSIG) != 0) ADDKEYVAL(argsp, RT_KY_TQSIG, rtqsig); *argsp = 0; if (rt_priocntl(P_PID, P_MYID, PC_SETXPARMS, "RT", args) == -1) fatalerr("%s: Can't reset real time parameters\n" "priocntl system call failed with errno %d\n", basenm, errno); (void) execvp(cmdargv[0], cmdargv); fatalerr("%s: Can't execute %s, exec failed with errno %d\n", basenm, cmdargv[0], errno); }
/* * Read the fx_dptbl values from infile, convert the time quantum values * to HZ resolution, do a little sanity checking and overwrite the table * in memory with the values from the file. */ static void set_fxdptbl(char *infile) { int i; int nfxdpents; char *tokp; pcinfo_t pcinfo; pcadmin_t pcadmin; fxadmin_t fxadmin; fxdpent_t *fx_dptbl; int linenum; ulong_t res; hrtimer_t hrtime; FILE *fp; char buf[512]; int wslength; char *endp; char name[512], value[512]; int len; (void) strcpy(pcinfo.pc_clname, "FX"); if (priocntl(0, 0, PC_GETCID, (caddr_t)&pcinfo) == -1) fatalerr("%s: Can't get FX class ID, priocntl system call " "failed with errno %d\n", basenm, errno); pcadmin.pc_cid = pcinfo.pc_cid; pcadmin.pc_cladmin = (char *)&fxadmin; fxadmin.fx_cmd = FX_GETDPSIZE; if (priocntl(0, 0, PC_ADMIN, (caddr_t)&pcadmin) == -1) fatalerr("%s: Can't get fx_dptbl size, priocntl system call " "failed with errno %d\n", basenm, errno); nfxdpents = fxadmin.fx_ndpents; if ((fx_dptbl = (fxdpent_t *)malloc(nfxdpents * sizeof (fxdpent_t))) == NULL) fatalerr("%s: Can't allocate memory for fx_dptbl\n", basenm); if ((fp = fopen(infile, "r")) == NULL) fatalerr("%s: Can't open %s for input\n", basenm, infile); linenum = 0; /* * Find the first non-blank, non-comment line. A comment line * is any line with '#' as the first non-white-space character. */ do { if (fgets(buf, sizeof (buf), fp) == NULL) fatalerr("%s: Too few lines in input table\n", basenm); linenum++; } while (buf[0] == '#' || buf[0] == '\0' || (wslength = strspn(buf, " \t\n")) == strlen(buf) || strchr(buf, '#') == buf + wslength); /* LINTED - unbounded string specifier */ if (sscanf(buf, " %[^=]=%s \n%n", name, value, &len) == 2 && name[0] != '\0' && value[0] != '\0' && len == strlen(buf)) { if (strcmp(name, "RES") == 0) { errno = 0; i = (int)strtol(value, &endp, 10); if (errno != 0 || endp == value || i < 0 || *endp != '\0') fatalerr("%s: Bad RES specification, " "line %d of input file\n", basenm, linenum); else res = i; } else { fatalerr("%s: Bad RES specification, " "line %d of input file\n", basenm, linenum); } } /* * The remainder of the input file should contain exactly enough * non-blank, non-comment lines to fill the table (fx_ndpents lines). * We assume that any non-blank, non-comment line is data for the * table and fail if we find more or less than we need. */ for (i = 0; i < fxadmin.fx_ndpents; i++) { /* * Get the next non-blank, non-comment line. */ do { if (fgets(buf, sizeof (buf), fp) == NULL) fatalerr("%s: Too few lines in input table\n", basenm); linenum++; } while (buf[0] == '#' || buf[0] == '\0' || (wslength = strspn(buf, " \t\n")) == strlen(buf) || strchr(buf, '#') == buf + wslength); if ((tokp = strtok(buf, " \t")) == NULL) fatalerr("%s: Too few values, line %d of input file\n", basenm, linenum); fx_dptbl[i].fx_quantum = atol(tokp); if (fx_dptbl[i].fx_quantum <= 0) { fatalerr("%s: fx_quantum value out of " "valid range; line %d of input,\n" "table not overwritten\n", basenm, linenum); } else if (res != HZ) { hrtime.hrt_secs = 0; hrtime.hrt_rem = fx_dptbl[i].fx_quantum; hrtime.hrt_res = res; if (_hrtnewres(&hrtime, HZ, HRT_RNDUP) == -1) fatalerr("%s: Can't convert specified " "resolution to ticks\n", basenm); if ((fx_dptbl[i].fx_quantum = hrtconvert(&hrtime)) == -1) fatalerr("%s: fx_quantum value out of " "valid range; line %d of input,\n" "table not overwritten\n", basenm, linenum); } if ((tokp = strtok(NULL, " \t")) != NULL && tokp[0] != '#') fatalerr("%s: Too many values, line %d of input file\n", basenm, linenum); } /* * We've read enough lines to fill the table. We fail * if the input file contains any more. */ while (fgets(buf, sizeof (buf), fp) != NULL) { if (buf[0] != '#' && buf[0] != '\0' && (wslength = strspn(buf, " \t\n")) != strlen(buf) && strchr(buf, '#') != buf + wslength) fatalerr("%s: Too many lines in input table\n", basenm); } fxadmin.fx_dpents = fx_dptbl; fxadmin.fx_cmd = FX_SETDPTBL; if (priocntl(0, 0, PC_ADMIN, (caddr_t)&pcadmin) == -1) fatalerr("%s: Can't set fx_dptbl, priocntl system call failed " "with errno %d\n", basenm, errno); }
/* * Set all processes in the set specified by idtype/idargv to real time * (if they aren't already real time) and set their real-time priority, * real-time quantum and real-time quantum signal to those specified by * rtpri, tqntm/res and rtqsig. */ static int set_rtprocs(idtype_t idtype, int idargc, char **idargv, uint_t cflags, pri_t rtpri, long tqntm, long res, int rtqsig) { pcinfo_t pcinfo; uintptr_t args[2*RT_KEYCNT+1]; uintptr_t *argsp = &args[0]; pri_t maxrtpri; hrtimer_t hrtime; char idtypnm[PC_IDTYPNMSZ]; int i; id_t id; int error = 0; /* * Get the real time class ID and max configured RT priority. */ (void) strcpy(pcinfo.pc_clname, "RT"); if (priocntl(0, 0, PC_GETCID, (caddr_t)&pcinfo) == -1) fatalerr("%s: Can't get RT class ID, priocntl system call" " failed with errno %d\n", basenm, errno); maxrtpri = ((rtinfo_t *)pcinfo.pc_clinfo)->rt_maxpri; /* * Validate the rtpri and res arguments. */ if ((cflags & RT_DOPRI) != 0) { if (rtpri > maxrtpri || rtpri < 0) fatalerr("%s: Specified real time priority %d out of" " configured range\n", basenm, rtpri); ADDKEYVAL(argsp, RT_KY_PRI, rtpri); } if ((cflags & RT_DOTQ) != 0) { hrtime.hrt_secs = 0; hrtime.hrt_rem = tqntm; hrtime.hrt_res = res; if (_hrtnewres(&hrtime, NANOSEC, HRT_RNDUP) == -1) fatalerr("%s: Can't convert resolution.\n", basenm); ADDKEYVAL(argsp, RT_KY_TQSECS, hrtime.hrt_secs); ADDKEYVAL(argsp, RT_KY_TQNSECS, hrtime.hrt_rem); } if ((cflags & RT_DOSIG) != 0) ADDKEYVAL(argsp, RT_KY_TQSIG, rtqsig); *argsp = 0; if (idtype == P_ALL) { if (rt_priocntl(P_ALL, 0, PC_SETXPARMS, "RT", args) == -1) { if (errno == EPERM) { (void) fprintf(stderr, "Permissions error encountered" " on one or more processes.\n"); error = 1; } else { fatalerr("%s: Can't reset real time parameters" "\npriocntl system call failed with" " errno %d\n", basenm, errno); } } } else if (idargc == 0) { if (rt_priocntl(idtype, P_MYID, PC_SETXPARMS, "RT", args) == -1) { if (errno == EPERM) { (void) idtyp2str(idtype, idtypnm); (void) fprintf(stderr, "Permissions error" " encountered on current %s.\n", idtypnm); error = 1; } else { fatalerr("%s: Can't reset real time parameters" "\npriocntl system call failed with" " errno %d\n", basenm, errno); } } } else { (void) idtyp2str(idtype, idtypnm); for (i = 0; i < idargc; i++) { if (idtype == P_CID) { (void) strcpy(pcinfo.pc_clname, idargv[i]); if (priocntl(0, 0, PC_GETCID, (caddr_t)&pcinfo) == -1) fatalerr("%s: Invalid or unconfigured" " class %s, priocntl system call" " failed with errno %d\n", basenm, pcinfo.pc_clname, errno); id = pcinfo.pc_cid; } else { id = (id_t)str2num(idargv[i], INT_MIN, INT_MAX); if (errno) fatalerr("%s: Invalid id \"%s\"\n", basenm, idargv[i]); } if (rt_priocntl(idtype, id, PC_SETXPARMS, "RT", args) == -1) { if (errno == EPERM) { (void) fprintf(stderr, "Permissions error encountered on" " %s %s.\n", idtypnm, idargv[i]); error = 1; } else { fatalerr("%s: Can't reset real time" " parameters\npriocntl system call" " failed with errno %d\n", basenm, errno); } } } } return (error); }