source: proiecte/ptvs/src/vnsim/core/CarInfo.java @ 31

/************************************************************************************
 * Copyright (C) 2008 by Politehnica University of Bucharest and Rutgers University
 * All rights reserved.
 * Refer to LICENSE for terms and conditions of use.
 ***********************************************************************************/
package vnsim.core;


import java.nio.ByteBuffer;

import vnsim.map.object.*;


/**
 * Class that holds GPS & state information about a vehicle, accessibile to
 * the applications. 
 *
 */

public class CarInfo 
{
        protected long timestamp;       // can be int
        protected double speed;
        protected short roadIdx = -1;
        protected short pointIdx = -1;
        protected byte direction;       // 1 -  car runs on a street, from the first point 
                                                                //              to the last one, in they are stored in the
                                                                //              in the road's points vector
                                                                // 0 -  otherwise
        
        protected byte hpoz;    //0 behind, 1 center, 2 in front
        protected byte vpoz;    //0 left, 1 center, 2 right
                                                        //(position related to the point on the road to achieve
                                                        //car positioning on lanes)

        
        protected byte signal;  // 0 - through
                                                        // 1 - left
                                                        // 2 - right
        
        protected byte state;   //3 bits describing the state of the car
                                                        // = 0 - ok
                                                        // = 1 - damaged
                                                        // = 2 - crashed
                                                        // = 3 - promiscuous mode
        
        // added for simulator:
        protected double offset;
        protected byte lane;
        
        protected int vehicleId;

        public CarInfo() {
        }
        public CarInfo(double speed, short roadIdx, short pointIdx, byte direction, double offset, byte lane) {
                this.speed = speed; 
                this.roadIdx = roadIdx;
                this.pointIdx = pointIdx;
                this.direction = direction;
                this.offset = offset;
                this.lane = lane;
        }
        public CarInfo(double speed, short roadIdx, short pointIdx, byte infoByte) {
                this.speed = speed; 
                this.roadIdx = roadIdx;
                this.pointIdx = pointIdx;
                parseInfoByte(infoByte);
        }
        
        public CarInfo(CarInfo x) 
        {
                this.vehicleId = x.vehicleId;
                this.speed = x.speed;
                this.roadIdx = x.roadIdx;
                this.pointIdx = x.pointIdx;
                this.direction = x.direction;
                this.vpoz = x.vpoz;
                this.hpoz = x.hpoz;
                this.state = x.state;
                this.offset = x.offset;
                this.lane = x.lane;


        }

//      public boolean equals(Object arg0) {
//              CarInfo ci = (CarInfo)arg0;
//              return (roadIdx == ci.getRoadIdx() && pointIdx == ci.getPointIdx());
//      }
        
        public void setPoz(double sin, double cos){
        //determine hpoz and vpoz related to the point on the road,
        //having the angle between the segment AB (A crt point on the road obtained with peano keys, 
        //B real position of the car) and segment BC (C previuos point on the road)
                double cos60 = 0.5;
                double cos30 = java.lang.Math.sqrt(3)/2;

                if (sin > 0)
                        hpoz = 2;       //right
                else
                        hpoz = 0;       //left
                
/*              if (cos > cos30){
                        vpoz = 0;       //behind
                        hpoz = 1;       //center
                }
                if (cos < cos30 && cos > cos60){
                        vpoz = 0;       //behind
                        if (sin > 0)
                                hpoz = 2;       //right
                        else
                                hpoz = 0;       //left
                }
                if (cos > - cos60 && cos < cos60){
                        vpoz = 1;       //center
                        if (sin > 0)
                                hpoz = 2;       //right
                        else
                                hpoz = 0;       //left
                }
                if (cos > - cos30 && cos < - cos60){
                        vpoz = 2;       //in front
                        if (sin > 0)
                                hpoz = 2;       //right
                        else
                                hpoz = 0;       //left
                }
                if (cos < - cos30){
                        vpoz = 2;       //in front
                        hpoz = 1;       //center
                }*/
                
        }
        
        public void parseInfoByte(byte b)
        {
                this.direction = (byte)((b & 0x80) >> 7);
//              this.vpoz = (byte)((b & 0x60) >> 5);
                this.signal = (byte)((b & 0x60) >> 5);
                this.hpoz = (byte)((b & 0x18) >> 3);
                this.state = (byte)(b & 0x7);
        }
        
        public byte createInfoByte(){
                byte b = 0;
                b = (byte)((this.direction << 7) + 
//                      (this.vpoz << 5) +
                        (this.signal << 5) +
                        (this.hpoz << 3) +
                        (this.state));

                return b;
        }
        
        public byte getDirection() {
                return direction;
        }

        public void setDirection(byte direction) {
                this.direction = direction;
        }

        public byte getHpoz() {
                return hpoz;
        }

        public void setHpoz(byte hpoz) {
                this.hpoz = hpoz;
        }

        public short getPointIdx() {
                return pointIdx;
        }

        public void setPointIdx(short pointIdx) {
                this.pointIdx = pointIdx;
        }

        public short getRoadIdx() {
                return roadIdx;
        }
        public void setRoadIdx(short roadIdx) {
                this.roadIdx = roadIdx;
        }
        public double getSpeed() {
                return speed;
        }
        public void setSpeed(double speed) {
                this.speed = speed;
        }
        public byte getVpoz() {
                return vpoz;
        }
        public void setVpoz(byte vpoz) {
                this.vpoz = vpoz;
        }
        public byte getState() {
                return state;
        }
        public void setState(byte state) {
                this.state = state;
        }
        
        public long getTimestamp() {
                return timestamp;
        }
        public void setTimestamp(long timestamp) {
                this.timestamp = timestamp;
        }


        // added:
        
        public double getOffset() {
                return offset;
        }

        public void setOffset(double offset) {
                this.offset = offset;
        }
        public byte getLane() {
                return lane;
        }
        public void setLane(byte lane) {
                this.lane = lane;
        }
        
        public String toString(){
                return vehicleId+" - " + "ri:"+roadIdx+", pi:"+pointIdx+", of:"+offset+", ln:"+lane;
        } 

        public byte[] toBytes(){
                ByteBuffer bb = ByteBuffer.allocate(Globals.NONAGG_RECORD_SIZE);
                
                bb.putInt(this.vehicleId);
                bb.putLong(this.timestamp);
                bb.put((byte)this.speed);
                bb.putShort(this.roadIdx);
                bb.putShort(this.pointIdx);
                bb.put(createInfoByte());
                bb.put(this.lane);
                bb.putDouble(this.offset);
                return bb.array();
        }

        public void wrap(byte buffer[]){
                
                ByteBuffer bb = ByteBuffer.wrap(buffer);
                
                this.vehicleId = bb.getInt();
                this.timestamp = bb.getLong();
                this.speed = bb.get();
                this.roadIdx = bb.getShort();
                this.pointIdx = bb.getShort();
                byte infoByte = bb.get();
                parseInfoByte(infoByte);
                this.lane = bb.get();
                this.offset = bb.getDouble();
        }
        public void wrap(byte buffer[], int index){
                
                ByteBuffer bb = ByteBuffer.wrap(buffer, index, buffer.length - index);
                
                this.vehicleId = bb.getInt();
                this.timestamp = bb.getLong();
                this.speed = bb.get();
                this.roadIdx = bb.getShort();
                this.pointIdx = bb.getShort();
                byte infoByte = bb.get();
                parseInfoByte(infoByte);
                this.lane = bb.get();
                this.offset = bb.getDouble();
        }
        
        
        public int getVehicleId() {
                return vehicleId;
        }
        public void setVehicleId(int vehicleId) {
                this.vehicleId = vehicleId;
        }
        public boolean equals(Object arg0) {
                if (!(arg0 instanceof CarInfo)) return false;
                CarInfo sci = (CarInfo)arg0;
                return (vehicleId == sci.getVehicleId());
        }
        public byte getSignal() {
                return signal;
        }
        public void setSignal(byte signal) {
                this.signal = signal;
        }

}