Ejemplo n.º 1
0
    is_init = False
    niveau_count = 0
    platau_count = 0

    print "signal walking"
    for i in range(1, buffer.size-1):

        ksum = 0
        for k in range(-1,2):
            w = -k
            ksum += buffer.value(i+k) * w

        print ksum
        if is_init:
            diff = ksum - last_ksum

        last_ksum = ksum
        is_init = True


size = 10
data = [0 for i in range(size)]
buffer = CircularBuffer(data, size)

for i in range(25):
    #buffer.add((i-5)**2.0)
    buffer.add(i)
    peak_detect(buffer)


                #if args.preview_max_queue == 0 or preview_queue_in.qsize() < args.preview_max_queue:
                if True:
                    if args.debug_preview_threading:
                        #print(f'Main thread enqueuing frame no: {preview_counter} because preview_queue_in.size: {preview_queue_in.qsize()}...')
                        print(
                            f'Main thread enqueuing frame no: {preview_counter} because len(ringbuffer): {len(ringbuffer)}...'
                        )
                    # data is originally represented as a flat 1D array, it needs to be converted into HxW form
                    depth_h, depth_w = in_depth.getHeight(), in_depth.getWidth(
                    )
                    if args.debug_img_sizes:
                        print(f'{depth_h = } - {depth_w = }')
                    depth_frame = in_depth.getData().reshape(
                        (depth_h, depth_w)).astype(np.uint8)
                    if not ringbuffer.isFull():
                        ringbuffer.add((preview_counter, depth_frame, disp_img,
                                        rr_img, colored_disp))
                    #preview_queue_in.put((preview_counter, ringbuffer))
                    if args.debug_preview_threading:
                        print(
                            f'len(ringbuffer): {len(ringbuffer)} - {ringbuffer}...'
                        )
                    preview_counter += 1

            cmap_counter += 1

    except KeyboardInterrupt:
        # Keyboard interrupt (Ctrl + C) detected
        if args.disparity:
            videodepthFile.close()
        else:
            videoleftFile.close()