Yosef Guevara Salamanca
/
TETS_PC
bien spi no se queda pegado
tets_pc.cpp@3:b77f80e91118, 2018-09-12 (annotated)
- Committer:
- djinn77
- Date:
- Wed Sep 12 04:55:20 2018 +0000
- Revision:
- 3:b77f80e91118
- Parent:
- 2:f9d289ee6b30
- Child:
- 4:1d1a3b0021d5
Stop de movimiento
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
djinn77 | 0:4b2603e81763 | 1 | #include "mbed.h" |
djinn77 | 1:d99b6299bad8 | 2 | #include "piezas.h" |
djinn77 | 1:d99b6299bad8 | 3 | //#define DEBUG 1 |
djinn77 | 0:4b2603e81763 | 4 | |
djinn77 | 0:4b2603e81763 | 5 | Serial pc(USBTX,USBRX); |
djinn77 | 0:4b2603e81763 | 6 | SPI deviceM(PB_15, PB_14, PB_13); |
djinn77 | 0:4b2603e81763 | 7 | DigitalOut ssel (PB_12); |
djinn77 | 0:4b2603e81763 | 8 | |
djinn77 | 3:b77f80e91118 | 9 | int memoria[8]={0}; |
djinn77 | 0:4b2603e81763 | 10 | |
djinn77 | 0:4b2603e81763 | 11 | void debuging(char*s,...){ |
djinn77 | 0:4b2603e81763 | 12 | |
djinn77 | 0:4b2603e81763 | 13 | #if DEBUG |
djinn77 | 0:4b2603e81763 | 14 | pc.printf(s); |
djinn77 | 0:4b2603e81763 | 15 | #endif |
djinn77 | 0:4b2603e81763 | 16 | |
djinn77 | 0:4b2603e81763 | 17 | } |
djinn77 | 0:4b2603e81763 | 18 | |
djinn77 | 1:d99b6299bad8 | 19 | |
djinn77 | 0:4b2603e81763 | 20 | void sendSPI(uint8_t d1, uint8_t d2) |
djinn77 | 0:4b2603e81763 | 21 | { |
djinn77 | 0:4b2603e81763 | 22 | deviceM.unlock(); |
djinn77 | 0:4b2603e81763 | 23 | ssel=0; |
djinn77 | 0:4b2603e81763 | 24 | deviceM.write(d1); |
djinn77 | 0:4b2603e81763 | 25 | deviceM.write(d2); |
djinn77 | 0:4b2603e81763 | 26 | ssel=1; |
djinn77 | 0:4b2603e81763 | 27 | deviceM.lock(); |
djinn77 | 0:4b2603e81763 | 28 | }; |
djinn77 | 1:d99b6299bad8 | 29 | |
djinn77 | 1:d99b6299bad8 | 30 | |
djinn77 | 1:d99b6299bad8 | 31 | void captura_matriz(uint16_t* imprimir){ |
djinn77 | 1:d99b6299bad8 | 32 | |
djinn77 | 3:b77f80e91118 | 33 | for(int i=0; i<8; i++){ // realiza el desplazamiento de los bits |
djinn77 | 1:d99b6299bad8 | 34 | for (int j= 1; j<=8;j++){ // seleciona la columna a imprimir empezando desde la 1 |
djinn77 | 3:b77f80e91118 | 35 | |
djinn77 | 1:d99b6299bad8 | 36 | sendSPI(j, imprimir[j-1]>>i); |
djinn77 | 3:b77f80e91118 | 37 | |
djinn77 | 3:b77f80e91118 | 38 | |
djinn77 | 1:d99b6299bad8 | 39 | } |
djinn77 | 1:d99b6299bad8 | 40 | wait(1.5); |
djinn77 | 1:d99b6299bad8 | 41 | } |
djinn77 | 3:b77f80e91118 | 42 | |
djinn77 | 1:d99b6299bad8 | 43 | } |
djinn77 | 1:d99b6299bad8 | 44 | |
djinn77 | 1:d99b6299bad8 | 45 | |
djinn77 | 1:d99b6299bad8 | 46 | void desplazar(uint16_t* datos, char des){ |
djinn77 | 1:d99b6299bad8 | 47 | |
djinn77 | 1:d99b6299bad8 | 48 | uint16_t desplazamiento[8]={0}; |
djinn77 | 1:d99b6299bad8 | 49 | int j= 0; |
djinn77 | 1:d99b6299bad8 | 50 | |
djinn77 | 1:d99b6299bad8 | 51 | for(int i=des; i<(des+3);i++){ |
djinn77 | 1:d99b6299bad8 | 52 | desplazamiento[i]=datos[j]; |
djinn77 | 1:d99b6299bad8 | 53 | j++; |
djinn77 | 1:d99b6299bad8 | 54 | } |
djinn77 | 1:d99b6299bad8 | 55 | captura_matriz(desplazamiento); |
djinn77 | 1:d99b6299bad8 | 56 | } |
djinn77 | 1:d99b6299bad8 | 57 | |
djinn77 | 1:d99b6299bad8 | 58 | void read(){ |
djinn77 | 0:4b2603e81763 | 59 | |
djinn77 | 0:4b2603e81763 | 60 | pc.baud(38400); |
djinn77 | 3:b77f80e91118 | 61 | |
djinn77 | 0:4b2603e81763 | 62 | char pos= 0; |
djinn77 | 0:4b2603e81763 | 63 | char figura= 0; |
djinn77 | 0:4b2603e81763 | 64 | char giro= 0; |
djinn77 | 0:4b2603e81763 | 65 | debuging("\n Ingrese el posicion. "); |
djinn77 | 0:4b2603e81763 | 66 | pos=pc.getc(); |
djinn77 | 0:4b2603e81763 | 67 | debuging("\n Seleccione la Figura. "); |
djinn77 | 0:4b2603e81763 | 68 | figura=pc.getc(); |
djinn77 | 0:4b2603e81763 | 69 | debuging("\n Seleccione la rotacion. "); |
djinn77 | 0:4b2603e81763 | 70 | giro=pc.getc(); |
djinn77 | 0:4b2603e81763 | 71 | |
djinn77 | 0:4b2603e81763 | 72 | |
djinn77 | 0:4b2603e81763 | 73 | switch(figura){ |
djinn77 | 1:d99b6299bad8 | 74 | case 0: // L |
djinn77 | 1:d99b6299bad8 | 75 | switch(giro){ |
djinn77 | 1:d99b6299bad8 | 76 | case 0: |
djinn77 | 2:f9d289ee6b30 | 77 | desplazar(PZA_LD,pos); |
djinn77 | 1:d99b6299bad8 | 78 | break; |
djinn77 | 1:d99b6299bad8 | 79 | case 1: |
djinn77 | 2:f9d289ee6b30 | 80 | desplazar(PZA_LDN,pos); |
djinn77 | 1:d99b6299bad8 | 81 | |
djinn77 | 1:d99b6299bad8 | 82 | break; |
djinn77 | 1:d99b6299bad8 | 83 | case 2: |
djinn77 | 2:f9d289ee6b30 | 84 | desplazar(PZA_LDO,pos); |
djinn77 | 1:d99b6299bad8 | 85 | |
djinn77 | 1:d99b6299bad8 | 86 | break; |
djinn77 | 1:d99b6299bad8 | 87 | case 3: |
djinn77 | 2:f9d289ee6b30 | 88 | desplazar(PZA_LDD, pos); |
djinn77 | 1:d99b6299bad8 | 89 | |
djinn77 | 1:d99b6299bad8 | 90 | break; |
djinn77 | 0:4b2603e81763 | 91 | } |
djinn77 | 0:4b2603e81763 | 92 | break; |
djinn77 | 2:f9d289ee6b30 | 93 | case 1://T |
djinn77 | 2:f9d289ee6b30 | 94 | switch(giro){ |
djinn77 | 2:f9d289ee6b30 | 95 | case 0: |
djinn77 | 2:f9d289ee6b30 | 96 | desplazar(PZA_T, pos); |
djinn77 | 2:f9d289ee6b30 | 97 | break; |
djinn77 | 2:f9d289ee6b30 | 98 | case 1: |
djinn77 | 2:f9d289ee6b30 | 99 | desplazar(PZA_TN, pos); |
djinn77 | 2:f9d289ee6b30 | 100 | break; |
djinn77 | 2:f9d289ee6b30 | 101 | case 2: |
djinn77 | 2:f9d289ee6b30 | 102 | desplazar(PZA_TO, pos); |
djinn77 | 2:f9d289ee6b30 | 103 | break; |
djinn77 | 2:f9d289ee6b30 | 104 | case 3: |
djinn77 | 2:f9d289ee6b30 | 105 | desplazar(PZA_TD, pos); |
djinn77 | 2:f9d289ee6b30 | 106 | break; |
djinn77 | 0:4b2603e81763 | 107 | } |
djinn77 | 0:4b2603e81763 | 108 | |
djinn77 | 0:4b2603e81763 | 109 | break; |
djinn77 | 2:f9d289ee6b30 | 110 | case 2://I |
djinn77 | 2:f9d289ee6b30 | 111 | switch(giro){ |
djinn77 | 2:f9d289ee6b30 | 112 | case 0: case 2: |
djinn77 | 2:f9d289ee6b30 | 113 | desplazar(PZA_I, pos); |
djinn77 | 2:f9d289ee6b30 | 114 | break; |
djinn77 | 2:f9d289ee6b30 | 115 | case 1: case 3: |
djinn77 | 2:f9d289ee6b30 | 116 | desplazar(PZA_IR, pos); |
djinn77 | 2:f9d289ee6b30 | 117 | break; |
djinn77 | 0:4b2603e81763 | 118 | } |
djinn77 | 0:4b2603e81763 | 119 | break; |
djinn77 | 2:f9d289ee6b30 | 120 | case 3://Cuadrado |
djinn77 | 2:f9d289ee6b30 | 121 | switch(giro){ |
djinn77 | 2:f9d289ee6b30 | 122 | case 1: case 2: case 3: case 4: |
djinn77 | 2:f9d289ee6b30 | 123 | desplazar(PZA_C,pos); |
djinn77 | 2:f9d289ee6b30 | 124 | break; |
djinn77 | 0:4b2603e81763 | 125 | } |
djinn77 | 2:f9d289ee6b30 | 126 | break; |
djinn77 | 2:f9d289ee6b30 | 127 | case 5: //Z |
djinn77 | 2:f9d289ee6b30 | 128 | switch(giro){ |
djinn77 | 2:f9d289ee6b30 | 129 | case 0: |
djinn77 | 2:f9d289ee6b30 | 130 | desplazar(PZA_Z,pos); |
djinn77 | 2:f9d289ee6b30 | 131 | break; |
djinn77 | 2:f9d289ee6b30 | 132 | case 1: |
djinn77 | 2:f9d289ee6b30 | 133 | desplazar(PZA_ZN,pos); |
djinn77 | 2:f9d289ee6b30 | 134 | break; |
djinn77 | 2:f9d289ee6b30 | 135 | case 2: |
djinn77 | 2:f9d289ee6b30 | 136 | desplazar(PZA_ZO,pos); |
djinn77 | 2:f9d289ee6b30 | 137 | break; |
djinn77 | 2:f9d289ee6b30 | 138 | case 3: |
djinn77 | 2:f9d289ee6b30 | 139 | desplazar(PZA_ZD, pos); |
djinn77 | 2:f9d289ee6b30 | 140 | break; |
djinn77 | 2:f9d289ee6b30 | 141 | } |
djinn77 | 0:4b2603e81763 | 142 | |
djinn77 | 0:4b2603e81763 | 143 | break; |
djinn77 | 2:f9d289ee6b30 | 144 | |
djinn77 | 0:4b2603e81763 | 145 | } |
djinn77 | 0:4b2603e81763 | 146 | } |
djinn77 | 1:d99b6299bad8 | 147 | |
djinn77 | 0:4b2603e81763 | 148 | void inicializar(){ |
djinn77 | 0:4b2603e81763 | 149 | |
djinn77 | 0:4b2603e81763 | 150 | sendSPI(0x0c,1); |
djinn77 | 0:4b2603e81763 | 151 | sendSPI(0x0b,7); |
djinn77 | 0:4b2603e81763 | 152 | sendSPI(0x09,0); |
djinn77 | 0:4b2603e81763 | 153 | sendSPI(0x0A,0x0f); |
djinn77 | 0:4b2603e81763 | 154 | int i; |
djinn77 | 0:4b2603e81763 | 155 | for (i=0;i<2;i++){ |
djinn77 | 0:4b2603e81763 | 156 | sendSPI(0x0F,1); |
djinn77 | 0:4b2603e81763 | 157 | wait (0.5); |
djinn77 | 0:4b2603e81763 | 158 | sendSPI(0x0f,0); |
djinn77 | 0:4b2603e81763 | 159 | wait (0.5); |
djinn77 | 0:4b2603e81763 | 160 | } |
djinn77 | 0:4b2603e81763 | 161 | |
djinn77 | 0:4b2603e81763 | 162 | } |
djinn77 | 0:4b2603e81763 | 163 | |
djinn77 | 0:4b2603e81763 | 164 | |
djinn77 | 0:4b2603e81763 | 165 | int main() { |
djinn77 | 0:4b2603e81763 | 166 | inicializar(); |
djinn77 | 0:4b2603e81763 | 167 | while(1){ |
djinn77 | 1:d99b6299bad8 | 168 | read(); |
djinn77 | 0:4b2603e81763 | 169 | } |
djinn77 | 0:4b2603e81763 | 170 | |
djinn77 | 0:4b2603e81763 | 171 | |
djinn77 | 0:4b2603e81763 | 172 | |
djinn77 | 0:4b2603e81763 | 173 | |
djinn77 | 0:4b2603e81763 | 174 | } |