nambah buat eksternal

Dependencies:   mbed encoderKRAI Motor_new

Committer:
Yolandataniaa
Date:
Mon Jun 21 07:48:27 2021 +0000
Revision:
1:bbe0769f00e9
Parent:
0:49e87dcad299
revisi

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Yolandataniaa 0:49e87dcad299 1 //
Yolandataniaa 0:49e87dcad299 2
Yolandataniaa 0:49e87dcad299 3 #include <Motor.h>
Yolandataniaa 0:49e87dcad299 4 #include <encoderKRAI.h>
Yolandataniaa 0:49e87dcad299 5 #include <mbed.h>
Yolandataniaa 0:49e87dcad299 6 #include "encoderHAL.h"
Yolandataniaa 0:49e87dcad299 7 #include "millis/millis.h"
Yolandataniaa 0:49e87dcad299 8
Yolandataniaa 0:49e87dcad299 9 //declare
Yolandataniaa 0:49e87dcad299 10 //encoderKRAI encoder_eks(PB_10,PB_3,538,encoderKRAI::X4_ENCODING);// input pin
Yolandataniaa 1:bbe0769f00e9 11 encoderHAL enc_eks(TIM3);
Yolandataniaa 0:49e87dcad299 12 //encoderKRAI encoder(PA_8,PC_9,538,encoderKRAI::X4_ENCODING);// input pin
Yolandataniaa 0:49e87dcad299 13 Serial pc(USBTX, USBRX,115200);
Yolandataniaa 0:49e87dcad299 14 Motor main_motor(PA_7 , PA_11, PB_12);
Yolandataniaa 1:bbe0769f00e9 15 DigitalIn pin1(PB_8);
Yolandataniaa 1:bbe0769f00e9 16 DigitalIn pin2(PB_9);
Yolandataniaa 1:bbe0769f00e9 17 DigitalIn pin3(PB_4);
Yolandataniaa 1:bbe0769f00e9 18 DigitalIn pin4(PB_5);
Yolandataniaa 1:bbe0769f00e9 19 DigitalIn pin5(PB_6);
Yolandataniaa 1:bbe0769f00e9 20 DigitalIn pin6(PB_7);
Yolandataniaa 1:bbe0769f00e9 21
Yolandataniaa 1:bbe0769f00e9 22 I2C i2c (PB_7, PB_6);
Yolandataniaa 1:bbe0769f00e9 23
Yolandataniaa 1:bbe0769f00e9 24 const int addr = 0x90;
Yolandataniaa 0:49e87dcad299 25
Yolandataniaa 0:49e87dcad299 26 //double pulse;
Yolandataniaa 0:49e87dcad299 27 double pulse_eks;
Yolandataniaa 0:49e87dcad299 28 uint32_t samp_enc_ex = 0;
Yolandataniaa 1:bbe0769f00e9 29 int32_t val1, val2, val3, val4, val5, val6;
Yolandataniaa 1:bbe0769f00e9 30
Yolandataniaa 0:49e87dcad299 31
Yolandataniaa 0:49e87dcad299 32 int main (){
Yolandataniaa 1:bbe0769f00e9 33 // startMillis();
Yolandataniaa 0:49e87dcad299 34 while(1){
Yolandataniaa 1:bbe0769f00e9 35 // if (millis() - samp_enc_ex > 10){
Yolandataniaa 0:49e87dcad299 36 pulse_eks += (double)enc_eks.getPulses(1);
Yolandataniaa 0:49e87dcad299 37 // pulse = (double)encoder.getPulses();
Yolandataniaa 1:bbe0769f00e9 38 i2c.write(addr, pulse_eks, 1);
Yolandataniaa 1:bbe0769f00e9 39 //val1= pin1.read();
Yolandataniaa 1:bbe0769f00e9 40 // val2= pin2.read();
Yolandataniaa 1:bbe0769f00e9 41 // val1 = enc_eks.getPulses(0);
Yolandataniaa 1:bbe0769f00e9 42 // pc.printf("%d\n", val1);
Yolandataniaa 1:bbe0769f00e9 43 // samp_enc_ex = millis();
Yolandataniaa 1:bbe0769f00e9 44 // }
Yolandataniaa 0:49e87dcad299 45
Yolandataniaa 0:49e87dcad299 46 }
Yolandataniaa 0:49e87dcad299 47 }