Colony

#!/usr/bin/env python

from scipy import linalg, array

from gtk import *

from socket import *

from struct import *

import gobject

import sys, pickle, pygtk, gtk, string, cairo, gobject, math, weakref

from random import random

#mine

from model import model

pi = 3.1415927

#endmine

class map_model(model):

    def __init__(self):

        self.eqn = []

    def __setattr__(self,name,value):

        self.__dict__[name] = value

        self.changed()

    def add_eqn(self, eqn):

        self.eqn = [eqn] + self.eqn

hostname = 'localhost'

class Screen(gtk.DrawingArea):

    __gsignals__ = { "expose-event" : "override" }

    def __init__ (self, socket):

        gtk.DrawingArea.__init__(self)

        self.xres, self.yres = (800,800)

        self.set_size_request(self.xres, self.yres)

        self.socket = socket

        self.bots = []

        self.draw = map_model()

        self.draw.bot = [1,1,pi/2] # x y theta

        self.draw.add_dependent(self.redraw)

        self.scale_const = 50

        self.xdisp = 400

        self.ydisp = 400

        self.nticks = 21

        self.units = 10

    def redraw(self, eqn):

        self.clear_area()

        self.draw_bot()

        self.draw_grid()

    def do_expose_event(self, event):

        self.redraw(None)

    def clear_area(self):

        self.ctx = self.window.cairo_create()

        self.ctx.rectangle(0,0,1000,1000)

        self.ctx.set_source_rgb(1,1,1)

        self.ctx.fill()

    def draw_bot(self):

        self.ctx = self.window.cairo_create()

        self.ctx.new_path()

        x, y, theta = self.draw.bot

        y = -y #because we don't want to draw down more units

        #draw blob

        self.ctx.set_source_rgb(0,1,0)

        xscl = (self.xres - self.xdisp) / self.units

        yscl = (self.yres - self.ydisp) / self.units

        cx = x * xscl + self.xdisp

        cy = y * yscl + self.ydisp

        self.ctx.arc(cx, cy, 20, 0, 2*pi)

        self.ctx.fill()

        #draw "arrow"

        self.ctx.set_source_rgb(0,0,1)

        self.ctx.arc(cx,cy, 5, 0, 2*pi)

        self.ctx.fill()

        self.ctx.move_to(cx,cy)

        dx = 20 * math.cos(theta + 0.05)

        dy = -20 * math.sin(theta + 0.05)

        dx = int(dx)

        dy = int(dy)

        self.ctx.rel_line_to(dx, dy)

        self.ctx.stroke()

    def draw_grid(self):

        self.ctx.set_source_rgb(0,0,0)

        self.ctx.new_path()

        #vertical

        self.ctx.move_to(400,0)

        self.ctx.rel_line_to(0,800)

        self.ctx.stroke()

        #vticks

        self.ctx.move_to(400,0)

        for i in range( self.nticks + 1 ):

            self.ctx.rel_line_to(5,0)

            self.ctx.stroke()

            self.ctx.move_to(400, i * 800 / self.nticks)

        #horiz

        self.ctx.move_to(0,400)

        self.ctx.rel_line_to(800,0)

        self.ctx.stroke()

        #hticks

        self.ctx.move_to(0,400)

        for i in range(self.nticks + 1):

            self.ctx.rel_line_to(0,-5)

            self.ctx.stroke()

            self.ctx.move_to(i * 800 / self.nticks, 400)

    def draw_graph(self, equations, n):

        self.ctx = self.window.cairo_create()

        self.ctx.set_source_rgb(0,0,0)

        self.ctx.new_path()

        for equn in equations:

            xmin, xmax = equn[-2],equn[-1]

            eqn = equn[:-2]

            dx = float(xmax - xmin) / n

            x = xmin

            y = 0

            for i in range(len(eqn)):

                y += eqn[-1 * i - 1] * ( x ** i)

            self.ctx.move_to(self.x_disp + x * self.scale_const,400 - y * self.scale_const)

            for diffel in range(1,n+1):

                x = xmin + diffel * dx

                y = 0

                for i in range(len(eqn)):

                    y += eqn[-1 * i - 1] * ( x ** i)

                self.ctx.line_to(self.x_disp + int(x * self.scale_const),400 - int(y * self.scale_const))

                self.ctx.stroke()

                self.ctx.move_to(self.x_disp + int(x * self.scale_const),400 - int(y * self.scale_const))

    def receive_info(self):

        buf = self.socket.recv(100)

        if (buf):

            items = unpack('4c2hf5h')

            print items

#         info = self.draw.bot

#         dx = random() * 2 - 1

#         dy = random() * 2 - 1

#         self.draw.bot = [info[0] + dx, info[1] + dx, info[2]]

        return True

def solve(lisvals):

    p0y, p1y, m0y, m1y, x0, x1 = lisvals

    A = array([[x0**3 , x0**2 , x0 , 1],

               [x1**3 , x1**2 , x1 , 1],

               [3 * x0**2 , 2 * x0 , 1 , 0],

               [3 * x1**2 , 2 * x1 , 1 , 0]])

    B = array([p0y, p1y, m0y, m1y])

    tarr = linalg.solve(A,B)

    lis = []

    for i in range(4):

        lis.append(tarr[i])

    return lis + [0,1]

def main():

    window = gtk.Window()

    window.connect("delete-event", gtk.main_quit)

    sock = socket()

    sock.connect((hostname, int(sys.argv[1])))

#    mywidg = Screen(sock)

    mywidg = Screen(sock)

    bigbox = gtk.HBox()

    bigbox.pack_end(mywidg, True, True, 0)

    window.add(bigbox)

    bigbox.show()

    mywidg.show()

    window.show()

    gobject.idle_add(mywidg.receive_info)

 #   gobject.timeout_add(250, mywidg.receive_info)

    gtk.main()

if __name__=='__main__':

    if (len(sys.argv) < 2): #or not str.isdecimal(sys.argv[1])):

        print("Usage: %s <portno>" % sys.argv[0])

        sys.exit()

    main()

     int tmp = 0;

     short int tprint;

     printf("Made socket\n");

	  bzero(buffer, 256);

	       buffer[1] = (char) received->length;

	       buffer[3] = 0;

	       memcpy(buffer+4, received->packet, received->length);

	       memcpy(&tprint, buffer+4, 2);

	       printf("%d\n", tprint);

	       n = write(newsockfd, buffer, 22);

#define CHANNEL 0xE

     wl_set_channel(CHANNEL);

from struct import *

    funcs = {1 : 'print_range_info'}

    packet_length = packet[1]

    data = packet[3 : 3+packet_length]

    print("data length: %d" % len(data))

    ranges = unpack('hhhhhhh',data)

    print(ranges)

DEFS=-DWL_DEBUG -DXBEE_SPECIAL

	$(CC) $(CFLAGS) $(INCS) $(DEFS) ../../libwireless/lib/*.c server.c netserv.c robots.c -o server