X-Git-Url: http://rtime.felk.cvut.cz/gitweb/mf624-simulink.git/blobdiff_plain/df8e3d947add25fec417be0e61fb3bc3633d36b4..4d56091f3f22165080f52d32d4a25f02d951aab6:/mf624_SIMULINK.c

diff --git a/mf624_SIMULINK.c b/mf624_SIMULINK.c
index 59242a5..ebd2276 100644
--- a/mf624_SIMULINK.c
+++ b/mf624_SIMULINK.c
@@ -216,6 +216,16 @@ double ADC_read(mf624_state_t* mfst, adc_channel_t channel)
 	return 10.0 * ((int16_t) (result << 2)) / (double) 0x8000;
 }
 
+extern uint32_t IRC_mode_change(mf624_state_t* mfst, uint32_t change_mask, uint32_t change_val)
+{
+	/* This sequence should be protected by mutex to protect changes in multirate systems */
+	mfst->IRC_mode = (mfst->IRC_mode & ~change_mask) | (change_val & change_mask);
+	mf624_write32(mfst->IRC_mode, MFST2REG(mfst, 4, IRCCTRL_reg));
+        /*printf("change_mask 0x%08x, change_val 0x%08x\n", change_mask, change_val);*/
+        /*printf("IRC mode set to %08lx\n", mfst->IRC_mode);*/
+	return mfst->IRC_mode;
+}
+
 
 static int open_device(char* path) {
 	int device_fd;