--peng 1/14/2014

--TSS Result variables and parameters

--Definition here has highest precedence (can be specified here or via command line args)

TSS RESULT-VAR posR1

TSS RESULT-VAR oposR1

-- include atomic definitions

PARS INCLUDE atomic

-- include environment model

PARS INCLUDE empty_environment

CONST REAL Tstep=1.0 -- discrete time step of environment model

CONST REAL MaxSpeed=300.0 -- speed in mm per timestep

CONST REAL BaseSpeed=200.0 -- speed in mm per timestep

CONST REAL AngSpeed=0.29 -- angular velocity in radians per timestep; 0.29 rps is 17 dps, 0.17 rps is 10 dps

-- include the CNL definitions

PARS INCLUDE cnl

-- include robot 1 definitions

PARS INCLUDE robot1

-- constants for the mission

CONST NORM P01=(P01mean,P01var) --* Robot 1 initial position distribution

CONST VEC2F P01mean=(5500,500)

CONST VEC4F P01var=(500,0,0,500)

CONST VEC2F V0=(0,0) --* initial velocity

CONST VEC2F G1=(17500,500) -- 12m, 40 s at 0.3 m/s

CONST VEC2F G2=(17500,12500) -- 12m, 40 s at 0.3 ms/

CONST VEC2F G90=(0,1) -- +90 degree heading unit-vector (if original heading was (1,0)), 5.2s at 17dps, 9s at 10dps

CONST VEC2F Gr=(18000,13000)

CONST NORM Z0R1=(Z0mean,Z0var)

CONST NORM Z0R2=(Z0mean,Z0var)

CONST NORM H0=(H0R1mean,H0var)

CONST VEC2F H0R1mean=(1.0,0.0) --* initial heading unit vector

CONST VEC4F H0var=(0,0,0,0)

CONST NORM H0R1=(H0R1mean,H0var)

Mission (piM,obM,siM,hM,odM)(voM) =

Coop<1,1,1,G1>(odM,cV101,cC101,cC102)(voM) |

Move_to<G1,2000,1.5>(odM)(cV101) |

Noise<Z0,G1>(odM)(cC101) |

Avoid_Obstacles<Z0,G1>(odM,obM)(cC102) |

(Is_at_goal(odM); Spin(hM)(voM)) |

(Is_at_head(hM); Coop<1,1,1,G2>(odM,cV201,cC201,cC202)(voM)) |

(Is_at_head(hM); Move_to<G2,2000,1.5>(odM)(cV201)) |

(Is_at_head(hM); Noise<Z0,G2>(odM)(cC201)) |

(Is_at_head(hM); Avoid_Obstacles<Z0,G2>(odM,obM)(cC202)) .

--System is the concurrent composition of controller (Mission) and environment (Robots)

SYS = Mission (cPOS,cOB,cSEN,cHEAD,cOPOS)(cVEL) |

Robot1<P01,Z0R1,H0R1,Z0R1,H0R1mean,P01>(cVEL)(cPOS,cOB,cSEN,cHEAD,cOPOS) .

-- NO GOAL PROCESS NETWORK DEFINED - GOAL IS BY TERMINATION

-- (c) Fordham University Robotics and Computer Vision