xref: /onnv-gate/usr/src/lib/libplot/t300s/common/subr.c (revision 0:68f95e015346)
1*0Sstevel@tonic-gate /*
2*0Sstevel@tonic-gate  * CDDL HEADER START
3*0Sstevel@tonic-gate  *
4*0Sstevel@tonic-gate  * The contents of this file are subject to the terms of the
5*0Sstevel@tonic-gate  * Common Development and Distribution License, Version 1.0 only
6*0Sstevel@tonic-gate  * (the "License").  You may not use this file except in compliance
7*0Sstevel@tonic-gate  * with the License.
8*0Sstevel@tonic-gate  *
9*0Sstevel@tonic-gate  * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
10*0Sstevel@tonic-gate  * or http://www.opensolaris.org/os/licensing.
11*0Sstevel@tonic-gate  * See the License for the specific language governing permissions
12*0Sstevel@tonic-gate  * and limitations under the License.
13*0Sstevel@tonic-gate  *
14*0Sstevel@tonic-gate  * When distributing Covered Code, include this CDDL HEADER in each
15*0Sstevel@tonic-gate  * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
16*0Sstevel@tonic-gate  * If applicable, add the following below this CDDL HEADER, with the
17*0Sstevel@tonic-gate  * fields enclosed by brackets "[]" replaced with your own identifying
18*0Sstevel@tonic-gate  * information: Portions Copyright [yyyy] [name of copyright owner]
19*0Sstevel@tonic-gate  *
20*0Sstevel@tonic-gate  * CDDL HEADER END
21*0Sstevel@tonic-gate  */
22*0Sstevel@tonic-gate /*	Copyright (c) 1984, 1986, 1987, 1988, 1989 AT&T	*/
23*0Sstevel@tonic-gate /*	  All Rights Reserved  	*/
24*0Sstevel@tonic-gate 
25*0Sstevel@tonic-gate 
26*0Sstevel@tonic-gate /*
27*0Sstevel@tonic-gate  * Copyright 2005 Sun Microsystems, Inc.  All rights reserved.
28*0Sstevel@tonic-gate  * Use is subject to license terms.
29*0Sstevel@tonic-gate  */
30*0Sstevel@tonic-gate 
31*0Sstevel@tonic-gate #pragma ident	"%Z%%M%	%I%	%E% SMI"	/* SVr4.0 1.3	*/
32*0Sstevel@tonic-gate /*LINTLIBRARY*/
33*0Sstevel@tonic-gate 
34*0Sstevel@tonic-gate #include <signal.h>
35*0Sstevel@tonic-gate #include <stdio.h>
36*0Sstevel@tonic-gate #include <stdlib.h>
37*0Sstevel@tonic-gate #include <unistd.h>
38*0Sstevel@tonic-gate #include <plot.h>
39*0Sstevel@tonic-gate #include "con.h"
40*0Sstevel@tonic-gate 
41*0Sstevel@tonic-gate static void
delay(void)42*0Sstevel@tonic-gate delay(void)
43*0Sstevel@tonic-gate {
44*0Sstevel@tonic-gate 	int i;
45*0Sstevel@tonic-gate 	for (i = 0; i < 2; i++) {
46*0Sstevel@tonic-gate 		(void) ioctl(OUTF, TCSBRK, 1);
47*0Sstevel@tonic-gate 	}
48*0Sstevel@tonic-gate }
49*0Sstevel@tonic-gate 
50*0Sstevel@tonic-gate int
xconv(int xp)51*0Sstevel@tonic-gate xconv(int xp)
52*0Sstevel@tonic-gate {
53*0Sstevel@tonic-gate 	/*
54*0Sstevel@tonic-gate 	 * x position input is -2047 to +2047,
55*0Sstevel@tonic-gate 	 * output must be 0 to PAGSIZ*HORZRES
56*0Sstevel@tonic-gate 	 */
57*0Sstevel@tonic-gate 	xp += 2048;
58*0Sstevel@tonic-gate 	/* the computation is newx = xp*(PAGSIZ*HORZRES)/4096 */
59*0Sstevel@tonic-gate 	return (int)(xoffset + xp / xscale);
60*0Sstevel@tonic-gate }
61*0Sstevel@tonic-gate 
62*0Sstevel@tonic-gate int
yconv(int yp)63*0Sstevel@tonic-gate yconv(int yp)
64*0Sstevel@tonic-gate {
65*0Sstevel@tonic-gate 	/* see description of xconv */
66*0Sstevel@tonic-gate 	yp += 2048;
67*0Sstevel@tonic-gate 	return (int)(yp / yscale);
68*0Sstevel@tonic-gate }
69*0Sstevel@tonic-gate 
70*0Sstevel@tonic-gate void
inplot(void)71*0Sstevel@tonic-gate inplot(void)
72*0Sstevel@tonic-gate {
73*0Sstevel@tonic-gate 	spew(ESC);
74*0Sstevel@tonic-gate 	spew(INPLOT);
75*0Sstevel@tonic-gate }
76*0Sstevel@tonic-gate 
77*0Sstevel@tonic-gate void
outplot(void)78*0Sstevel@tonic-gate outplot(void)
79*0Sstevel@tonic-gate {
80*0Sstevel@tonic-gate 	spew(ESC);
81*0Sstevel@tonic-gate 	spew(ACK);
82*0Sstevel@tonic-gate 	spew(ESC);
83*0Sstevel@tonic-gate 	spew(ACK);
84*0Sstevel@tonic-gate 	(void) fflush(stdout);
85*0Sstevel@tonic-gate }
86*0Sstevel@tonic-gate 
87*0Sstevel@tonic-gate void
spew(char ch)88*0Sstevel@tonic-gate spew(char ch)
89*0Sstevel@tonic-gate {
90*0Sstevel@tonic-gate 	(void) putc(ch, stdout);
91*0Sstevel@tonic-gate }
92*0Sstevel@tonic-gate 
93*0Sstevel@tonic-gate void
tobotleft(void)94*0Sstevel@tonic-gate tobotleft(void)
95*0Sstevel@tonic-gate {
96*0Sstevel@tonic-gate 	move(-2048, -2048);
97*0Sstevel@tonic-gate }
98*0Sstevel@tonic-gate 
99*0Sstevel@tonic-gate void
reset(void)100*0Sstevel@tonic-gate reset(void)
101*0Sstevel@tonic-gate {
102*0Sstevel@tonic-gate 	struct termio ITTY;
103*0Sstevel@tonic-gate 	(void) signal(SIGINT, SIG_IGN);
104*0Sstevel@tonic-gate 	outplot();
105*0Sstevel@tonic-gate 	(void) ioctl(OUTF, TCSETAW, &ITTY);
106*0Sstevel@tonic-gate 	_exit(0);
107*0Sstevel@tonic-gate }
108*0Sstevel@tonic-gate 
109*0Sstevel@tonic-gate float
dist2(int x1,int y1,int x2,int y2)110*0Sstevel@tonic-gate dist2(int x1, int y1, int x2, int y2)
111*0Sstevel@tonic-gate {
112*0Sstevel@tonic-gate 	float t, v;
113*0Sstevel@tonic-gate 	t = x2 - x1;
114*0Sstevel@tonic-gate 	v = y1 - y2;
115*0Sstevel@tonic-gate 	return (t * t + v * v);
116*0Sstevel@tonic-gate }
117*0Sstevel@tonic-gate 
118*0Sstevel@tonic-gate void
swap(int * pa,int * pb)119*0Sstevel@tonic-gate swap(int *pa, int *pb)
120*0Sstevel@tonic-gate {
121*0Sstevel@tonic-gate 	int t;
122*0Sstevel@tonic-gate 	t = *pa;
123*0Sstevel@tonic-gate 	*pa = *pb;
124*0Sstevel@tonic-gate 	*pb = t;
125*0Sstevel@tonic-gate }
126*0Sstevel@tonic-gate 
127*0Sstevel@tonic-gate #define	DOUBLE 010
128*0Sstevel@tonic-gate #define	ADDR 0100
129*0Sstevel@tonic-gate #define	COM 060
130*0Sstevel@tonic-gate #define	MAXX 070
131*0Sstevel@tonic-gate #define	MAXY 07
132*0Sstevel@tonic-gate #define	SPACES 7
133*0Sstevel@tonic-gate 
134*0Sstevel@tonic-gate void
movep(int ix,int iy)135*0Sstevel@tonic-gate movep(int ix, int iy)
136*0Sstevel@tonic-gate {
137*0Sstevel@tonic-gate 	int dx, dy, remx, remy, pts, i;
138*0Sstevel@tonic-gate 	int xd, yd;
139*0Sstevel@tonic-gate 	char c, addr, command;
140*0Sstevel@tonic-gate 	if ((xnow == ix) && (ynow == iy))
141*0Sstevel@tonic-gate 		return;
142*0Sstevel@tonic-gate 	inplot();
143*0Sstevel@tonic-gate 	dx = ix - xnow;
144*0Sstevel@tonic-gate 	dy = iy - ynow;
145*0Sstevel@tonic-gate 	command = COM|PENUP|((dx < 0) << 1)|(dy < 0);
146*0Sstevel@tonic-gate 	dx = abs(dx);
147*0Sstevel@tonic-gate 	dy = abs(dy);
148*0Sstevel@tonic-gate 	xd = dx / (SPACES*2);
149*0Sstevel@tonic-gate 	yd = dy / (SPACES*2);
150*0Sstevel@tonic-gate 	pts = xd < yd ? xd : yd;
151*0Sstevel@tonic-gate 	if ((i = pts) > 0) {
152*0Sstevel@tonic-gate 		c = command|DOUBLE;
153*0Sstevel@tonic-gate 		addr = ADDR;
154*0Sstevel@tonic-gate 		if (xd > 0)
155*0Sstevel@tonic-gate 			addr |= MAXX;
156*0Sstevel@tonic-gate 		if (yd > 0)
157*0Sstevel@tonic-gate 			addr |= MAXY;
158*0Sstevel@tonic-gate 		spew(c);
159*0Sstevel@tonic-gate 		delay();
160*0Sstevel@tonic-gate 		while (i--) {
161*0Sstevel@tonic-gate 			spew(addr);
162*0Sstevel@tonic-gate 			delay();
163*0Sstevel@tonic-gate 		}
164*0Sstevel@tonic-gate 	}
165*0Sstevel@tonic-gate 	if (xd != yd) {
166*0Sstevel@tonic-gate 		if (xd > pts) {
167*0Sstevel@tonic-gate 			i = xd - pts;
168*0Sstevel@tonic-gate 			addr = ADDR|MAXX;
169*0Sstevel@tonic-gate 		} else {
170*0Sstevel@tonic-gate 			i = yd - pts;
171*0Sstevel@tonic-gate 			addr = ADDR|MAXY;
172*0Sstevel@tonic-gate 		}
173*0Sstevel@tonic-gate 		c = command|DOUBLE;
174*0Sstevel@tonic-gate 		spew(c);
175*0Sstevel@tonic-gate 		delay();
176*0Sstevel@tonic-gate 		while (i--) {
177*0Sstevel@tonic-gate 			spew(addr);
178*0Sstevel@tonic-gate 			delay();
179*0Sstevel@tonic-gate 		}
180*0Sstevel@tonic-gate 	}
181*0Sstevel@tonic-gate 	remx = dx - xd * SPACES * 2;
182*0Sstevel@tonic-gate 	remy = dy - yd * SPACES * 2;
183*0Sstevel@tonic-gate 	addr = ADDR;
184*0Sstevel@tonic-gate 	i = 0;
185*0Sstevel@tonic-gate 	if (remx > 7) {
186*0Sstevel@tonic-gate 		i = 1;
187*0Sstevel@tonic-gate 		addr |= MAXX;
188*0Sstevel@tonic-gate 		remx -= 7;
189*0Sstevel@tonic-gate 	}
190*0Sstevel@tonic-gate 	if (remy > 7) {
191*0Sstevel@tonic-gate 		i = 1;
192*0Sstevel@tonic-gate 		addr |= MAXY;
193*0Sstevel@tonic-gate 		remy -= 7;
194*0Sstevel@tonic-gate 	}
195*0Sstevel@tonic-gate 	while (i--) {
196*0Sstevel@tonic-gate 		spew(command);
197*0Sstevel@tonic-gate 		delay();
198*0Sstevel@tonic-gate 		spew(addr);
199*0Sstevel@tonic-gate 		delay();
200*0Sstevel@tonic-gate 	}
201*0Sstevel@tonic-gate 	if ((remx > 0) || (remy > 0)) {
202*0Sstevel@tonic-gate 		spew(command);
203*0Sstevel@tonic-gate 		delay();
204*0Sstevel@tonic-gate 		spew(ADDR|remx << 3|remy);
205*0Sstevel@tonic-gate 		delay();
206*0Sstevel@tonic-gate 	}
207*0Sstevel@tonic-gate 	xnow = ix;
208*0Sstevel@tonic-gate 	ynow = iy;
209*0Sstevel@tonic-gate 	outplot();
210*0Sstevel@tonic-gate }
211*0Sstevel@tonic-gate 
212*0Sstevel@tonic-gate int
xsc(int xi)213*0Sstevel@tonic-gate xsc(int xi)
214*0Sstevel@tonic-gate {
215*0Sstevel@tonic-gate 	int xa;
216*0Sstevel@tonic-gate 	xa = (int)((xi - obotx) * scalex + botx);
217*0Sstevel@tonic-gate 	return (xa);
218*0Sstevel@tonic-gate }
219*0Sstevel@tonic-gate 
220*0Sstevel@tonic-gate int
ysc(int yi)221*0Sstevel@tonic-gate ysc(int yi)
222*0Sstevel@tonic-gate {
223*0Sstevel@tonic-gate 	int ya;
224*0Sstevel@tonic-gate 	ya = (int)((yi - oboty) * scaley + boty);
225*0Sstevel@tonic-gate 	return (ya);
226*0Sstevel@tonic-gate }
227