#include "../h/rccl.h"

static int t0;

pumatask()
{
	TRSF_PTR z, e , b, pa1, pa2, pivot;
	POS_PTR  p0, pt1, pt2;
	int pivotfn();
	int i;

	pivot = newtrans("PIVOT", pivotfn);
	z = gentr_trsl("Z",  0.,  0., 864.);
	e = gentr_trsl("E" , 0. , 0. , 170.);
	b = gentr_rot("B", 600. , -300., 700., yunit, 180.);
	pa1 = gentr_eul("PA1"  , 30., 0., 50., -10., 10., 0.);
	pa2 = gentr_eul("PA2"  , -30., 0., 50., 10., -10., 0.);

	p0 = makeposition("P0" , z, t6, e, EQ, b, TL, e);
	pt1 = makeposition("PT1", pivot, z, t6, e, EQ, b, pa1, TL, e);
	pt2 = makeposition("PT2", pivot, z, t6, e, EQ, b, pa2, TL, e);

	setvel(300, 20);
	setmod('c');
	setime(200, 0);
	move(p0);
	waitfor(completed);
	t0 = rtime;
	for (i = 0; i < 6; ++i) {
		move(pt1);
		move(pt2);
	}
	setvel(400, 100);
	setmod('j');
	move(park);
}

pivotfn(t)
TRSF_PTR t;
{
	Rot(t, zunit, (t0 - rtime) * .010);
}
