35 lines
680 B
C
35 lines
680 B
C
#include <stdio.h>
|
|
#include "pico/stdlib.h"
|
|
#include "hardware/gpio.h"
|
|
#include "pico/binary_info.h"
|
|
|
|
#include "gyro.h"
|
|
|
|
const uint LED_PIN = 25;
|
|
|
|
int main() {
|
|
bi_decl(bi_program_description("This is a test binary."));
|
|
bi_decl(bi_1pin_with_name(LED_PIN, "On-board LED"));
|
|
|
|
stdio_init_all();
|
|
|
|
gpio_init(LED_PIN);
|
|
gpio_set_dir(LED_PIN, GPIO_OUT);
|
|
gpio_put(LED_PIN, 1);
|
|
|
|
sleep_ms(3000);
|
|
|
|
Gyro_Init();
|
|
|
|
while (1) {
|
|
u_int16_t step_ms = 100;
|
|
/*gpio_put(LED_PIN, 0);
|
|
sleep_ms(251);
|
|
gpio_put(LED_PIN, 1);
|
|
puts("Bonjour");
|
|
sleep_ms(1000);*/
|
|
sleep_ms(step_ms);
|
|
Gyro_Read(step_ms);
|
|
}
|
|
}
|