 4ad5245969
			
		
	
	
		4ad5245969
		
			
		
	
	
	
	
		
			
			* App lfrfid: update emulator to process external data. * App lfrfid: cleanup emulator * App lfrfid: cli interface * Lib: arguments parser lib Co-authored-by: あく <alleteam@gmail.com>
		
			
				
	
	
		
			73 lines
		
	
	
		
			2.1 KiB
		
	
	
	
		
			C++
		
	
	
	
	
	
			
		
		
	
	
			73 lines
		
	
	
		
			2.1 KiB
		
	
	
	
		
			C++
		
	
	
	
	
	
| #include "rfid-timer-emulator.h"
 | |
| 
 | |
| extern TIM_HandleTypeDef htim1;
 | |
| 
 | |
| RfidTimerEmulator::RfidTimerEmulator() {
 | |
| }
 | |
| 
 | |
| RfidTimerEmulator::~RfidTimerEmulator() {
 | |
|     std::map<LfrfidKeyType, EncoderGeneric*>::iterator it;
 | |
| 
 | |
|     for(it = encoders.begin(); it != encoders.end(); ++it) {
 | |
|         delete it->second;
 | |
|         encoders.erase(it);
 | |
|     }
 | |
| }
 | |
| 
 | |
| void RfidTimerEmulator::start(LfrfidKeyType type, const uint8_t* data, uint8_t data_size) {
 | |
|     if(encoders.count(type)) {
 | |
|         current_encoder = encoders.find(type)->second;
 | |
| 
 | |
|         if(lfrfid_key_get_type_data_count(type) == data_size) {
 | |
|             current_encoder->init(data, data_size);
 | |
| 
 | |
|             api_hal_rfid_tim_emulate(125000);
 | |
|             api_hal_rfid_pins_emulate();
 | |
| 
 | |
|             api_interrupt_add(timer_update_callback, InterruptTypeTimerUpdate, this);
 | |
| 
 | |
|             // TODO make api for interrupts priority
 | |
|             for(size_t i = WWDG_IRQn; i <= DMAMUX1_OVR_IRQn; i++) {
 | |
|                 HAL_NVIC_SetPriority(static_cast<IRQn_Type>(i), 15, 0);
 | |
|             }
 | |
| 
 | |
|             HAL_NVIC_SetPriority(TIM1_UP_TIM16_IRQn, 5, 0);
 | |
|             HAL_NVIC_EnableIRQ(TIM1_UP_TIM16_IRQn);
 | |
| 
 | |
|             api_hal_rfid_tim_emulate_start();
 | |
|         }
 | |
|     } else {
 | |
|         // not found
 | |
|     }
 | |
| }
 | |
| 
 | |
| void RfidTimerEmulator::stop() {
 | |
|     api_hal_rfid_tim_emulate_stop();
 | |
|     api_interrupt_remove(timer_update_callback, InterruptTypeTimerUpdate);
 | |
| 
 | |
|     api_hal_rfid_tim_reset();
 | |
|     api_hal_rfid_pins_reset();
 | |
| }
 | |
| 
 | |
| void RfidTimerEmulator::timer_update_callback(void* _hw, void* ctx) {
 | |
|     RfidTimerEmulator* _this = static_cast<RfidTimerEmulator*>(ctx);
 | |
|     TIM_HandleTypeDef* hw = static_cast<TIM_HandleTypeDef*>(_hw);
 | |
| 
 | |
|     if(api_hal_rfid_is_tim_emulate(hw)) {
 | |
|         bool result;
 | |
|         bool polarity;
 | |
|         uint16_t period;
 | |
|         uint16_t pulse;
 | |
| 
 | |
|         do {
 | |
|             _this->current_encoder->get_next(&polarity, &period, &pulse);
 | |
|             result = _this->pulse_joiner.push_pulse(polarity, period, pulse);
 | |
|         } while(result == false);
 | |
| 
 | |
|         _this->pulse_joiner.pop_pulse(&period, &pulse);
 | |
| 
 | |
|         api_hal_rfid_set_emulate_period(period - 1);
 | |
|         api_hal_rfid_set_emulate_pulse(pulse);
 | |
|     }
 | |
| }
 |