dim buf1(128)
dim buffer_pointer
dim Timer_count

dim Taster_count
dim Taster_status

dim LED_count

dim Akku_status
dim Telemetrie_rssi

dim A
dim B
dim C


#Boot
event system_boot(major, minor, patch, build, ll_version, protocol, hw)

        call hardware_io_port_config_direction(0,1)
	call hardware_io_port_config_direction(1,1)
	call hardware_io_port_write (0,1,0) 		#LED OFF

        call hardware_set_soft_timer(327, 1, 0)    #10ms

    
	call gap_set_mode(gap_general_discoverable,gap_undirected_connectable)
	call sm_set_bondable_mode(1)
	
	buffer_pointer = 0
end


#Timer event
event hardware_soft_timer(handle)

	#kommt nach 50ms kein byte mehr per UART, Puffer per Bluetooth senden
	
	if Timer_count = 5 then  		
	
		if buffer_pointer > 20 then
			call attributes_write(xgatt_rx, 0, 20, buf1(0:20))
			buffer_pointer = buffer_pointer - 20
			memcpy(buf1(0),buf1(20),buffer_pointer)
		end if
		if buffer_pointer > 0 & buffer_pointer < 21 then
			call attributes_write(xgatt_rx, 0, buffer_pointer, buf1(0:buffer_pointer))
			buffer_pointer = 0
			Timer_count = 0
		end if	
	else	
		Timer_count = Timer_count + 1
	end if
  end if
  
end


#Read UART
event system_endpoint_rx(endpoint, data_len, data_data)

	memcpy(buf1(buffer_pointer),data_data(0),data_len)
	buffer_pointer = buffer_pointer + data_len   
	
	Timer_count = 0
end