新部内対抗A班 / Mbed 2 deprecated circle_war_ver_A_NUCLEO__

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   mbed

Fork of circle_war_ver_A_NUCLEO_ by 新部内対抗A班

spi_nucleo.h

Committer:
baba2357
Date:
2016-04-03
Revision:
8:554e3d643b2d
Parent:
7:4f5cd0051db0
Child:
14:3403ce49a37a

File content as of revision 8:554e3d643b2d:

#include "mbed.h"
#include "pin_file.h"
#include <string.h>
#ifndef SPI_NUCLEO_H
#define SPI_NUCLEO_H

//SPI mbed
bool RR=0,LR=0,Xpm=0,cilinder=0,onoff=0,updown=0,Ypm=0;
int speed_X,speed_Y;
//SPI NUCLEO
void spi_mbed();
void spi_nucleo();
void getGyro();
void spiInit();
typedef unsigned u16;
u16 FM;
long int angle;
double now_angle;
Serial pc(USBTX,USBRX);
void spiInit();
void spi_mbed();
void getGyro();
#endif

void spiInit()
{
    from_mbed.format(16,3);
    from_gyro.format(16,3);
    from_mbed.frequency(1000000);
    from_gyro.frequency(1000000);
}

void spi_mbed()
{       
    if(from_mbed.receive()) {
        RR=0;
        LR=0;
        FM=from_mbed.read();
        Xpm=FM>>13;
        Ypm=(FM&0x10)>>4;
        cilinder=(FM&0x0100)>>8;
        onoff=(FM&0x0080)>>7;
        updown=(FM&0x0040)>>6;
        if((FM>>15)==1) {
            RR=1;
        } //右旋回の関数へ
        else if((FM>>14)==1) {
            LR=1;
        } //左旋回の関数へ
        else if(Xpm==1) { //コントローラーのＸ方向成分入力
            speed_X=FM&0x1e00;
            speed_X=speed_X>>9;
            if(Ypm==0) speed_Y=FM&0xf;
            else {
                speed_Y=FM&0xf;
                speed_Y=(-1)*speed_Y;
            }
        }
        else {
            speed_X=FM&0x1e00;
            speed_X=speed_X>>9;
            speed_X=(-1)*speed_X;
            if(Ypm==0) speed_Y=FM&0xf;
            else {
                speed_Y=FM&0xf;
                speed_Y=(-1)*speed_Y;
            }
        }
    }
}

void getGyro()
{
    int data;
    if(from_gyro.receive()) {
        data = from_gyro.read();
    if(data >> 15) angle = -(data & 0x7fff);
        else angle = data & 0x7fff;
        now_angle = (double)angle / 10;
//        pc.printf("%d\r\n",data);
    }
}